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ABSTRACT 


This  thesis  is  a  study  of  the  Omega  navigation  system  as 
currently  implemented  in  the  P-3C  aircraft.  The  possibility 
of  using  a  microcomputer  to  solve  the  internal  processing 
functions  is  investigated.  Data  flow  graphs  were  applied  to 
the  veloci-cy  and  navigation  processing  function  in  the  Omega 
system.  These  graphs  assisted  in  the  development  of  the 
PL/M  code  which  implements  the  function.  The  four  PL/M 
subroutines  that  were  written  can  compute  the  velocity  and 
navigation  equations  in  sufficient  time  and  with  sufficient 
accuracy  to  encourage  additional  research  into  a 
microcomputer  implementation  of  the  remaining  internal 
functions  of  the  Omega  system. 
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INTRODUCTION 


This  thesis  examines  the  use  of  a  microcomputer  to  solve 
the  internal  processing  functions  of  the  current  P-3C  Update 
Omega  navigation  system.  Tne  most  important  reason  for 
studying  a  microcomputer  for  the  Omega  navigation  system  is 
that  during  an  excessive  system  load  in  the  P-3C  aircraft, 
the  Omega  signal  processing  is  partially  inhibited. 
Operating  in  this  inhibited  mode  appeared  unnecessary  in  a 
sophisticated  system  such  as  the  P-3C  incorporates, 
especially  with  the  existing  technology  of  microprocessors 
and  distributed  systems  [ Refs.  1,  2,  and  3].  With  a 
microcomputer  dedicated  to  Omega  navigation  processing,  this 
inhibited  mode  of  operation  could  be  eliminated  and  position 
updating  information  could  be  available  continuously. 

The  analysis  of  the  existing  velocity  and  navigation 
processing  routine  utilizes  the  current  equations  in  the 
published  manual  on  the  P-3C  Update  system  functional 
description  for  Omega.  The  main  tool  for  the  analysis  is 
the  data  flow  graphs  of  the  existing  equations.  This  gives 
efficient  and  optimal  PL/M  code. 

Section  II  of  this  thesis  presents  fundamental 
information  applicable  to  the  worldwide  Omega  navigation 
system  and  the  AN/ARN-99(V)  receiver-converter.  Section  III 
introduces  the  various  internal  processing  functions  of  the 
system  and  presents  a  data  flow  graph  depicting  the 
parameters  which  apply  to  each  of  the  functions.  Section  IV 
presents  the  analysis  of  the  velocity  and  navigation 
processing  routine  with  applicable  data  flow  graphs. 
Section  V  gives  the  conclusion  of  the  study. 


II.   THEORY  OF  OMEGA  SYSTEM  OPERATION 


OMEGA  is  a  worldwide,  very  low  frequency  (VLF)  ,  radio 
navigation  system  which  utilizes  the  radiation  from  eight 
transmitting  stations  to  provide  global  coverage  to 
aircraft,  ships,  land- vehicles,  and  submarines  for  accurate 
and  reliable  positioning.  Table  I  lists  the  presently 
available  transmitting  stations  with  appropriate  letter 
designators,  coordinates,  and  direction  cosine  values  [Ref. 
4].  The  position  of  each  transmitting  station  is  shown  in 
Figure  1 . 


A.   SYSTEM  PRINCIPLES 


Each  of  the  eight  transmitting  stations  radiates 
continuous,  sinusoidal  wave  bursts  at  10.2  kHz,  13.6  kHz, 
and  11.3  kHz.  These  signals  are  phase  locked  and  time 
synchronized  to  Universal  Time  such  that  ail  three  signals 
start  at  zero  value  with  positive  slope  at  0000  hours 
Greenwich  Mean  Time  (GMT)  and  repeat  at  ten  second  intervals 
[Ref.  5].  Figure  2  depicts  a  standard  ten  second  interval 
transmission  pattern. 

In  order  to  understand  the  complexity  of  the  Omega 
navigation  system  and  the  operations  performed  by  the 
receiver  and  the  computer  software  functions,  a  simplified 
view  of  the  systems  operation  is  presented  first.  Assume 
some  arbitrary  transmitting  station  is  radiating  on  one  of 
the  three  frequencies,  and,  at  some  distance  d,  a  receiver 
is   acquiring   the   signal   for   future    processing.    The 


STATION 

LOCATION 

L AT/LONG 

DIRECTION    COSINE 

A 

Norway 

66°    25» 

12.39" 

N 

SA1    = 

+0.91551829 

13°       8" 

12.65" 

E 

SA2    = 
SA3    = 

+0.39172334 
+0.09153733 

B 

Liberia 

6°    18* 

19.39" 

N 

SB1    = 

+0.98221041 

10°    39' 

4  4.21" 

W 

SB2    = 
SB3    = 

+0.98117517 
-0. 16588382 

C 

Hawaii 

210    24' 

16.90" 

N 

SC1    = 

+0.36  283281 

157°    49» 

52.70" 

W 

SC2    = 
SC3    = 

-0.86296869 
-0.35162108 

D 

N. Dakota 

46°    21" 

57.20" 

N 

SD1    = 

+0.72144222 

98°    20' 

08.77" 

W 

SD2    = 
SD3    = 

-0. 10039077 
-0.68515398 

E 

LaReunion 

20°    58' 

26.47" 

S 

SE1    = 

-0.35585299 

Island 

55°    17« 

24.25" 

E 

SE2   = 
SE3    = 

+0.53214675 
+0.76823587 

P 

Argentina 

43°    03* 

12.53" 

S 

SF1    = 

-0.68022941 

65°    11' 

27.60" 

w 

SF2    = 
SF3    = 

+0.30756230 
-0.66535207 

G 

Trinidad 

10°    42' 

06.20" 

N 

SG1    = 

+0 . 18449565 

61°    38» 

20.30" 

W 

SG2    = 
SG3    = 

+0.46687116 
-0.86486570 

H 

Japan 

34°    46' 

53.26" 

N 

SH1    = 

+0.56547261 

129°    27» 

12.49" 

E 

SH2    = 

-0.52409936 

SH3    = 

+0.63683639 

TA3LE    I.       OMEGA   Stations 
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TRANSMITTING 
STATION 


A 
RECEIVER 


transmitted  signal  appears  as  a  standard  sinusoidal  wave. 
Assuming  no  attenuation  of  the  signal,  a  perfect  waveguide 
formed  by  the  earth  and  the  ionosphere  for  the  signal  to 
propagate  through,  no  interfering  carrier  or  noise  signal, 
and  the  transmission  traveling  at  the  speed  of  light,  the 
received  signal  would  appear  as  a  sinusoidal  wave  but  offset 
ai  the  receiver  in  time  t  by  d/c,  the  time  necessary  for  the 
signal  to  travel  distance  d  at  the  velocity  of  light  c. 


F(t)  =ro 


ro      t<o    r  (t)  =ro 
^SIN(wt)   t>o         ^sin  w(t- 


0<t<d/c 
d/c)    t>d/c 


However,  this  ideal  situation  is  rarely  achieved.  The 
propagated  signal  is  affected  by  several  factors  described 
in  a  subsequent  section.  Due  to  the  repetitive  nature  of 
sinusoidal  waves,  the  precise  number  of  wave  lengths  must  be 
computed  between  the  transmitter  and  the  receiver.  Also, 
the  absolute  time  t  of  the  transmitter  must  be  known.  These 
variables  are  calculated  in  the  combinational  filter. 

Position  fixing  with  the  use  of  OMEGA  signals  is 
accomplished  by  two  methods.  The  first  method  utilizes 
phase  difference  information  between  stations  and  the 
resultant  hyperDolic  lines  of  position.  The  second  method 
uses  circular  lines  of  position  obtained  by  measuring  phase 
with  respect  to  a  stable  frequency  standard.   The  P-3C  Omega 
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navigation  system  uses  the  circular   lines   of   position   or 
rho-rho  method  to  determine  position  fixes. 

Of  primary  importance  in  utilizing  the  OMEGA  VLF  signals 
for  the  rho-rho  method  are  the  ability  to  detect  and  measure 
the  phase  of  a  received  signal,  and  the  ability  to  predict 
the  phase  of  the  signal.  In  order  to  detect  and  measure  the 
phase  of  a  received  signal  using  the  rho-rho  method,  the 
first  process  performed  in  the  Omega  navigation  system  is  to 
relate  the  internal  clock  of  the  computer  with  the 
transmission  burst  pattern  of  the  stations.  This 
synchronization  process  is  described  in  more  detail  in  a 
subsequent  section.  The  overall  effect  allows  the  computer 
program  to  know  what  station  and  frequency  is  being 
processed  at  any  internal  system  time  t.  If  all  three 
frequencies  from  all  eignt  stations  could  be  received  at  any 
point  on  the  earth's  surface,  the  ten  second  reception 
pattern  would  appear  as  in  Figure  3.  For  a  more  realistic 
reception  pattern,  Figure  4  depicts  the  three  closest 
transmitter  stations  to  Hawaii,  and  Figure  5  represents  the 
signal  pattern  an  aircraft  would  receive  at  Hawaii. 

Once  synchronization  is  completed,  the  Omega  navigation 
system  commences  to  process  the  received  signals  through 
various  software  filters  in  order  to  measure  the  phase.  The 
filters  which  process  the  received  signal  are  composed  of 
three  burst  filters  (ie.  one  for  each  frequency)  and  24 
tracking  filters  (ie.  one  for  each  of  the  three  frequencies 
on  each  of  the  eight  stations) .  The  primary  function  of  the 
burst  filters  is  to  calculate  the  phase  measurement  and  the 
phase  variance  for  each  frequency  and  station  received  by 
the  receiver.  The  tracking  filter,  on  receiving  the  phase 
measurement  and  variance  of  the  phase  measurement  from  the 
burst  filter,  utilizes  these  values  to  acquire  a  more 
accurate  estimate  of  phase  and  phase  variance  over  several 
ten  second  time  intervals. 
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The  tracking  filter  performs  two  different  updates  on 
the  burst  filter  data.  The  first  update  is  a  time  update. 
This  update  is  required  because  of  the  displacement  of  the 
aircraft  receiver  between  successive  measurements  of  the 
received  signal.  The  time  update  procedure  projects  the 
last  estimate  of  phase  through  time  so  that  it  reflects  the 
new  position  of  the  aircraft.  These  procedures  are  defined 
as  rate  aiding  and  are  dependent  on  velocity  sources 
external  to  the  Omega  system.  In  estimating  the  change  in 
position,  it  is  possible  to  estimate  what  the  change  should 
be  for  a  particular  station  and  frequency.  This  predicted 
phase  change  is  then  added  to  the  last  estimate  of  phase  to 
create  a  new  phase  estimate. 

(DTRK(t)  =.J)TRK(t-1)  +  [A<f)DR(t)  +  A<t>ERR  (t-1)  ]  *  A  t 

where  A  <J)DR  (t)  is  the  phase  rate  which  represents  the 
average  rate  of  change  of  phase  along  the  arc  connecting  a 
station  and  the  aircraft,  and  A<f)ERR(t-1)  is  the  estimate  of 
the  error  in  the  phase  rate  and  is  calculated  in  the 
measurement  update  section.  The  second  update  is  a 
measurement  update,  and  is  performed  every  time  the  burst 
filter  supplies  a  measurement  of  phase  and  phase  variance  to 
the  tracking  filter.  This  measurement  update  procedure 
combines  the  rate  aiding  phase  estimate  from  the  tracking 
filter  with  the  burst  filter  phase  measurement  to  produce  a 
better  estimate  of  the  phase  based  on  the  following 
equation . 

<p    =  $JK  -  4>TRK(t)  +  [  A  0DR(t)  +A  02RR  (t)  ]  *  (0.425) 

where  (J)  is  defined  to  be  the  angular  difference  of  phase. 
The  combination  of  the  phase  measurement  from  the  burst 
filter  and  the  phase  estimate  from  the  tracking  filter  is  a 
weighted   average,  where  the  coefficients  are  computed  using 
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the  phase  variance   from   the  burst  filter  (cr  2$JK)  and   the 
phase  variance  from  the  tracking  filter  (cr  2$TRK)  . 


(J>TRK  (t)  =  <DTRK(t-1)  +  ARCTAN 


[ 


(cr  2(t)TRK  *  S) 


(  (cr  2$jk  +  cr  20TRK)  * 


» 


where  S  =  SIN  $    and  C  =  COS  d>. 

Once  the  measurement  of  phase  has  been  calculated,  it  is 
supplied  to  the  combinational  filter  for  processing  along 
with  a  phase  estimate  calibrated  in  the  propagation 
prediction  procedure.  With  the  measured  phase  and  the 
predicted  phase  available  for  position  fixing,  the  last 
requirement  to  be  implemented  for  utilization  of  the  rho-rho 
technique  of  position  fixing  is  to  synchronize  the  receiver 
oscillator  with  the  transmitter  oscillator.  This  is 
accomplished  in  the  combinational  filter  by  computing  the 
time  difference  between  the  transmitting  station  phase  and 
the  receiver  oscillator  phase. 

1 •   Signal  Coverage 

The  VLF  signals  utilized  by  the  OMEGA  system  are 
transmitted  ever  extremely  long  distances  of  the  earth's 
surface,  because  they  are  propagated  through  a  natural  wave 
guide  formed  by  the  surface  of  the  earth  and  the  ionosphere. 
Due  to  the  advantageous  properties  of  high  phase  stability 
and  low  attenuation  rates  of  VLF  signals,  no  modulation  of 
the  signals  is  required  prior  to  transmission.  Because  these 
signals  are  unmodulated,  only  their  relative  position  in  any 
ten  second  time  interval  enables  receivers  to  identify  the 
station  being  received.  Df  primary  importance  in  utilizing 
the  OMEGA  VLF  signals  are  the  ability  to  detect  and  measure 
the  phase  of  a  received  signal,  and  the  ability  to  predict 
the   phase  of  the  signal.   Several  factors  have  an  effect  on 
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the  propagation  of  VLF  signals  and  consequently  the  ability 
of  an  airborne  Omega  system  to  receive  and  process  the 
signals  for  accurate  positioning  [Ref.  6].  These  factors 
are  described  in  the  section  pertaining  to  propagation 
prediction. 

2 •   3ece iver-C onverter 

The  AN/ARN-99  receiver  was  developed  by  the 
Electronics  Division  of  the  Northrop  Corporation  in 
Hawthrons,  California.  It  was  designed  for  operation  with 
all  eight  transmitting  stations  and  to  provide  a  continuous 
update  of  aircraft  position.  The  receiver-converter 
installed  in  the  P-3C  consists  of  several  modular  assemblies 
as  shown  in  Figure  6.  The  antenna,  composed  of  two  loop 
antennas  fixed  at  right  angles  to  each  other  and  mounted  at 
45°  angles  to  the  aircraft  center  line,  is  controlled  by  the 
burst  filter  function  in  the  computer  through  the  antenna 
switching  matrix.  The  three  heterodyne  receivers  have  RF 
and  IF  sections  for  processing  of  the  input  signals.  The 
requirements  for  filtering  the  received  signals  in  these 
sections  are  very  stringent.  The  filtering  in  the  RF 
section  removes  the  R?  image,  including  all  frequencies  in 
the  area  of  the  harmonics  of  the  local  oscillator.  The 
narrow  band  filtering  in  the  IF  section  provides  for  the 
rejection  of  interfering  carriers.  In  addition,  limiters 
are  used  for  controlling  the  dynamic  signal  levels,  and  a 
bandpass  filter  is  used  to  remove  the  harmonics  created  by 
the  previous  limiters.  The  resultant  output  of  the  RF  and 
IF  filtering  sections  leaves  the  fundamental  frequency  as  a 
sinusoid.  This  output  is  fed  into  a  sine  and  cosine 
correlator  which  utilizes  a  square  reference  signal  to 
produce  an  output  of  two  direct  current  signals.  One  dc 
signal  is  proportional  to  the  sine  of  the  burst  phase,  and 
the  other  dc  signal  is  proportional  to   the   cosine   of   the 
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burst  phase.  These  dc  signals,  which  represent  the  measured 
phase  shift,  enter  the  analog  to  digital  converter  and  are 
transmitted  to  the  computer  section  through  the 
receiver-converter/computer  interface  box.  The  precision 
frequency  generator  provides  for  the  reference  signals  and 
test  signals  necessary  in  the  measuring  of  the  phase 
difference  of  the  receiver  signal  [Refs.  7,  8]. 
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III.   INTERNAL  PROCESSING  FUNCTIONS 


The  Omega  navigation  system  in  the  P-3C  aircraft  is  one 
of  five  navigation  subsystems  which  comprise  the  avionics 
navigation  system.  The  remaining  subsystems,  in  their 
priority  of  use,  are  a  primary  inertial,  a  secondary 
inertial,  a  doppler  radar,  and  an  air  data  computer.  Tne 
selection  and  utilization  of  each  subsystem  is  dependent:  on 
the  control  of  the  Navigator/Communicator  and  on  the 
availability  of  the  subsystem.  A  block  diagram  of  the 
navigation  subsystems  is  shown  in  Figure  7. 


A.   OMEGA  PROCESSING 


The  internal  processing  functions  of  the  Omega 
navigation  system  are  shown  in  Figure  8  [Ref.  4].  A  more 
detailed  description  of  the  internal  processing  functions  is 
presented  in  Figure  9  showing  the  pertinent  data  transferred 
between  the  functions. 

1 •   Initialization 

Initialization  of  the  Omega  navigation  system  begins 
with  the  insertion  of  the  date  and  time  entries  by  the 
Navigator/Communicator  and  subsequent  activation  of  the 
initial  en  top  condition  or  mark  aircraft  position.  The 
date  and  time  entries  are  used  within  the  propagation 
prediction  module  to  calculate  an  estimate  of  the  phase 
value  derived  from  current   aircraft   position  at  the  moment 
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of  initialization.  These  phase  values  are  used  to 
initialize  the  tracking  filters.  The  variance  values  within 
the  combinational  filter  are  also  initialized  at  this  time, 
and  the  position  matrix  R,  utilized  in  the  velocity  and 
navigation  processing  function,  is  initialized  based  on 
current  aircraft  latitude  and  longitude. 

2 •   Hardware  Testing 

Hardware  testing  begins  immediately  after  the 
termination  of  the  initialization  function,  and  also  after 
each  restart.  The  main  objective  of  the  hardware  testing 
module  is  to  determine  the  status  of  the  Omega 
receiver/converter.  Additionally,  hardware  testing  provides 
a  method  of  assuring  proper  operation  of  all  Omega 
equipment.  The  testing  involves  a  series  of  subtests  which 
validates  the  operation  of  the  input/output  interface 
between  the  receiver/converter  and  the  computer.  The 
subtests,  which  are  described  in  greater  detail  in  Ref.  4, 
are  a  communication  subtest,  a  coherence  status  subtest,  an 
Onega  output  subtest,  an  Omega  input  subtest,  a  phase  angle 
to  digital  subtest,  a  phase  counter  subtest,  and  a  RF/IF 
subtest.  An  oscillator  drift  subtest,  which  is  classified 
as  a  hardware  test,  is  not  implemented  until  single 
frequency  processing  commences  in  the  combinational  filter 
routine. 

3«   Synchronization 

Synchronization  of  the  Omega  navigation  system  to 
tiie  Omega  transmission  pattern  is  the  most  critical  function 
executed  by  the  navigation  system.  By  aligning  itself  with 
the  ten  second  interval  transmission  pattern,  the  Omega 
navigation   set   processes   the  correct  VLF  signal  bursts  in 
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subsequent  routines.  Synchronization  is  accomplished  by 
utilizing  the  variable  length  transmission  time  intervals  of 
the  various  frequencies  and  a  differential  correlation 
technique.  The  first  assumption  made  in  the  routine  is 
that  all  eight  stations  that,  are  presently  in  operation  are 
operating  on  all  three  frequencies.  The  routine,  starting 
at  some  random  time,  accepts  from  the  receiver-converter  a 
ten  second  interval  of  data  composed  of  100  sine  and  100 
cosine  values  over  contiguous  100  millisecond  intervals. 
One  hundred  correlation  coefficients  are  calculated  for  the 
frequency  under  consideration  utilizing  the  difference 
between  short  sum  and  long  sum  intervals  and  adding  these 
differences  over  the  eight  count  burst  pattern.  Figure  10 
d=cicts  the  short  sum  and  long  sum  intervals  over  a  ten 
second  interval  pattern,  and  the  limits  of  the  short  and 
long  sums.  The  correlation  coefficient  formula  is  given 
below . 


C(I)  =  £ 
J=1 
(1=1,  100) 


I  +  JU    .2  I   I+J'J    ,2  /  I  +  JU+2    >2  /  I  +  JU  +  2    ^2 
^  X(K) j+j   ^  Y(K)  -j    ^   X(K)|+j    ^   Y(K) 

,K=I+JL   /   \K=I  +  JL   /   \K=I+JL-2   /   \K=I+JL-2 


JU-JL  +  1 


JU-JL+5 


The  values  X (K)  and  Y  (K)  are  the  sine  and  cosine  values 
respectively  received  from  tne  receiver-converter.  Each  of 
the  confidence  coefficients  can  be  considered  to  be  a 
measurement  of  how  well  the  received  ten  second  burst 
pattern  matches  the  transmitted  burst  pattern.  The  higher 
the  coefficient  value,  the  greater  confidence  is  associated 
to  the  index  number  I  being  the  starting  point  of  the 
transmitted  burst  pattern  within  ±  50  milliseconds.  The 
four  largest  confidence  coefficients  are  saved  in  descending 
order  of  magnitude,  along  with  their  respective  index  number 
I.  This  index  number  is  used  in  determining  the  starting 
point  of  the  ten  second  burst  pattern.    Various   conditions 
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relating  to  the  four  highest  confidence  coefficients  and 
index  nuafcers  are  tested  in  order  to  determine  the  success 
or  the  failure  of  the  synchronization  attempt.  If  the 
current  confidence  level  fails,  the  next  seguential 
frequency  is  utilized  to  acquire  the  next  ten  second 
interval  cf  data.  The  synchronization  routine  continues  in 
this  mode  until  a  successful  synchronization  occurs  or  until 
the  Navigator/Communicator  intervenes. 
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4.   Burst  filter 


The  burst  filter  routine  commences  upon  successful 
completion  of  synchronization.  This  routine  calculates  the 
phase  measurements  and  the  variance  of  these  phase 
measurements  for  each  station  and  frequency  received  by  the 
Omega  navigation  set.  It  also  selects  the  optimal  antenna 
inputs  and  test  data  for  the  Omega  receiver,  maintains 
synchronization  with  the  transmitted  burst  pattern,  and 
computes  the  phase  measurement  and  its  confidence 
measurement  based  on  the  receiver  phase  difference  and  test 
data  from  the  receiver.   The  equations  are: 


<J)JK  =  ABCTAN 


(XbJK)' 
(YbJK) 


-  (J)OK  +  0* 


(7  2JK  = 


QtK  *  (AtJ  -  QJK) 
2  *  AtJ  *  (QJK  -  QtK)^ 


+  [  (0.  005)  *  (27T)  ]2 


where  (f>  •  is  a  phase  correction  (0°  or  180°)  added  to  the 
received  signal  to  account  for  error  in  reception,  <J)0K  is 
the   phase   angle   offset   for   frequency   K  computed  in  the 


calibration   measurement 


and   XbJK   and   YbJK   are 


burst 


measurement  sums  corrected  for  phantom  error. 


To  accomplish  these  calculations,  each  of  the  eight 
bursts  and  associated  slots  are  divided  into  intervals  of 
time  as  shown  in  Figure  11.  The  start  burst  and  end  burst 
intervals  are  periods  of  time  where  the  sine  and  cosine  data 
are  not  used.  These  intervals  are  considered  transient 
periods  cr  waiting  periods.  During  the  burst  interval,  the 
sine  and  cosine  values  received  are  used  in  the  calculation 
of  the  phase  measurement  and  variance  of  the  phase 
measurement.    In  the  test   interval,   various   measurements 
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are  computed  to  improve  the  accuracy  of  the  phase 
measurement,  and  for  the  issuing  of  antenna  selection  and 
test  selection  commands.  Reference  4,  pages  86  to  101, 
describes  in  detail  the  computations  involved  in  calculating 
the  phase  and  the  phase  variance  for  each  station  and 
frequency  used  by  the  Omega  navigation  system. 
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5 •   Tracking  Filters 

Once  the  burst  filter  processing  has  acquired  a 
phase  measurement  and  an  estimate  of  the  variance  of  the 
phase  measurement  for  a  specific  station  and  frequency, 
these  values  are  used  as  inputs  to  only  one  of  the  24 
tracking  filters.  Each  filter  is  similar  in  the  processing 
of  the  data,  tut  each  is  different  in  its  computational 
constants  for  the  various  frequencies  and  stations.  A 
simplified  description  of  a  tracking  filter  is  that  it  is 
utilized  tc  acquire  a  better  estimate  of  the  phase 
measurement  by  averaging  the  outputs  of  the  burst  filter 
over  successive  ten  second  intervals.  The  tracking  filter 
routine,  using  the  measured  phase  from  the  burst  filter  and 
an  updated  estimate  of  phase  based  upon  previous 
measurements  and  dead  reckoning  information,  combines  the 
measured  and  estimated  phase  and  utilizes  a  weighted  average 
to  compute  a  new  phase  estimate  and  phase  variance  estimate. 
Also  computed  within  the  tracking  filter  is  the  variance  of 
the  estimate  of  the  error  in  the  phase  rate  of  change  due  to 
aircraft  displacement  in  time.  Once  these  three  values  are 
computed  for  a  particular  station  and  frequency,  a  test  is 
made  to  determine  the  accuracy  of  the  phase  measurement.  If 
the  variance  of  the  phase  measurement  is  less  than  or  equal 
to  (0.06  ir  radians)2,  the  phase  measurement  is  considered 
accurate  enough  for  computations  within  the  combinational 
filter.  After  three  successive  measurements  and  successful 
tests,  a  flag  is  set  indicating  that  the  data  is  valid  and 
available,  and  the  combinational  filter  reads  the  outputs 
from  the  tracking  filter.  Once  the  outputs  have  been  read, 
the  count  of  successive  measurements  is  reset  to  zero,  the 
variances  of  the  phase  measurements  are  set  to  the 
initialization  values,  and  the  data  valid  and  available  flag 
is  cleared.   If  at  any  time   in   the   tracking   filter   the 
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variance  cf  the  phase  measurement  exceeds  (0.06  n  radians) 2, 
the  count  of  the  successive  measurements  is  reset  to  zero, 
and  the  data  valid  and  available  flag  is  cleared. 

6.   Combinational  Filter 


The  input  values  to  the  combinational  filter  from 
the  tracking  filter  are  the  refined  estimates  of  phase 
measurement,  (&TRK,  phase  variance,  <r  2<J)TRK,  and  phase  rate 
variance,  o~2(pE3R.  The  inputs  from  the  propagation 
prediction  routine  are  the  estimates  of  phase,  (J5PR0P, 
improved  for  propagation  effects  and  phase  variance, 
o-24>PROP.  within  the  combinational  filter  routine,  these 
input  values  are  statistically  combined  to  provide  the  best 
estimates  of  system  position  and  velocity.  The 
combinational  filter  routine  provides  for  the  conversion 
from  phase  tc  geodetic  coordinates  (latitude  and  longitude) , 
and  also  determines  the  phase  and  frequency  differences 
between  the  receiver  oscillator  and  the  transmitted  OMEGA 
signal.  Cnce  the  Omega  receiver  oscillator  is  calibrated, 
the  Omega  navigation  system  operates  when  only  two 
transmitting  stations  are  accessible.  In  addition,  the 
combinational  filter  is  used  for  lane  determination  through 
the  technique  of  multiple  state  vectors. 

a.   Description 

The  combinational  filter  is  a  Kalman  filter. 
Reference  4  describes  the  Kalman  filter  technique  to 
filtering  and  prediction  as  a  linear,  recursive,  minimum 
variance  filter.  R.  G.  Brown  and  L.  L.  Hagerman  £Ref.  9] 
describe  a  Kalman  filter  as  simply  a  means  of  estimating  the 
various  states  of  a  random  process  from  a  set  of  discrete 
measurements  having   a   known   linear   connection   to   these 
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states.  It  was  further  noted  in  Ref.  10,  that  a  Kalman 
filter  operates  only  on  the  system  errors  and  not  on  total 
quantities  such  as  position  and  velocity.  The  basic  concepts 
involved  are  those  of  stare,  state  transition,  measurement, 
and  optimal  weighting  [Ref.  11].  The  states  of  the 
combinational  filter  are  differentials  of  system  variables 
[ie.  error  in  position  (o<J)2  and  6<b3)  ,  oscillator  start  time 
(t0)  ,  rate  of  change  in  oscillator  start  time  (  t0  )  ,  and 
error  in  velocity  (&VC2  and  &VC3)  ].  The  following  chart 
describes  the  elements  of  the  state  vector  X  [6  x  1  ]. 

MEANING 
Position  error  along  the  -R2  directicn  of 
the  system  position  matrix  R. 
Position  error  along  the  -R3  direction  of 
the  system  position  matrix  R. 
Time  difference  between  the  transmitting 
station  phase  and  the  receiver  oscillator 
phase, 
a        t0    Time  rate  of  change  of  t0  . 

5  &7C2     Error  in  the  east  component  of  velocity 

which  is  error  along  the  R2  direction  of 
the  system  position  matrix  R. 

6  £vC3     Error  in  the  north  component  of  velocity 

which  is  error  along  the  R3  direction  of 
the  system  position  matrix  R. 

The  state  of  the  system  is  described  by  the 
solution  of  linear  vector  differential  equations  depicting 
system  error  growth.  The  Kalman  filter  method  linearly 
combines  the  previous  estimate  of  the  state  vector,  X,  with 
a  measurement  to  approach  a  minimum  variance  estimation. 
This  minimum  variance  estimate  is  then  time  updated  until 
the  following  measurement.  The  measurement  calculation  is 
explained  by  the  following  equations. 
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Y  =  <f)TRK  -  <J)PROP 

where  Y  is  the  difference  between  the  tracking  filter  phase 
measurement  and  the  propagation  prediction  phase  estimate  of 
the  phase  measurement. 

Residual  =  Y  -  M*X(t-1) 

where  Residual  (RES)  is  the  difference  between  the 
calculated  error  in  the  measurement,  Y,  and  the  system 
estimate  of  the  error,  M*X  (t-1)  .  The  state  vector  X(t-1)  is 
the  previous  estimate  of  the  state  vector,  and  a  [1  x  6]  is 
the  measurement  matrix  described  below. 

ELEMENT       EQUATIONS  MEANING 

3 

1  EHEB  *  /      R2J*5IJ  EMER  is  the  earths  mean  equa- 
J=J torial  radius  =  20925741.47  ft 

K  *  SIN(J)D)   R2J  and  R3J  are  the  elements  of 
the  R2  and  R3  vectors  of  the 
3  position  matrix  R. 

2  EMER  *  y   R3J*SIJ   SIJ's  (I=A,B,..,H)  are  the 

j= 1  elements  of  the  station 

K  *  SIN(<J)D)   direction  cosine  values. 

3  VL  VL  is  the  average  propagation 
\K  velocity,  and  AK  (K=1,2,3)  is 

the  wave  lengths  of  the 
frequencies  10.28,11.3,  13.6kHz 


where  0D  =  ARCC0S(  y  R1J*SIJ)  and  the  remaining  elements  of 

J=1 
H   are   zero.    New,   minimum   variance,   state   vectors  are 
produced  by  using  the  following  equations. 
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Xnew  =  Xold  +  b  *  (RES) 

where  b  [6  x  1  ]  is  the  optimal  weighting  vector  matrix. 

This  optimal  weighting  vector,  b,  is  established 
by  means  of  time  propagation  of  system  error  growth  in 
combination  with  information  contained  within  the 
measurement.  The  weighting  is  a  function  of  the  covariance 
matrix,  P  [6  x  6],  of  the  difference  between  system  error 
state  vector,  X,  and  the  average  state  vector  Xavg. 

P  =  E  *  [  (X  -  Xavg)  *  (X  -  Xavg)T  ] 

where  E  is  the  expected  value  of  the  difference  between  the 
value  of  the  difference  between  the  value  for  the  real  state 
vector  X,  if  all  conditions  were  known,  and  the  average 
state  vector,  Xavg.  The  following  chart  describes  the 
elements  cf  the  covariance  matrix  P. 

ELEMENT   SYMEOLS  MEANING 

P11      c  2<t2    The  position  variance  for  the  position 

error,  o<l)2 ,  along  the  -R2  direction 
P22     o-  2<t>3    The  position  variance  for  the  position 

error,  6(1)3,  along  the  -R3  direction 
P33     o~  2t0    The  variance  of  oscillator  phase  offset 
P4U     cr  2t0   The  variance  of  oscillator  drift  rate 
P55     o~  2VC2   The  variance  of  the  error  in  the  east 

component  of  velocity  6vC2 
E66     c   2VC3   The  variance  of  the  error  in  the  north 

component  of  velocity  o*VC3 

All  remaining  elements  of  the  covariance  matrix  are  zero. 

The  combinational  filter  effectively  computes 
optimal  estimates  cf  position  and  velocity  along  with  the 
remaining   elements   of  a   state  vector.  The  filter  uses  an 
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observation  of  the  difference  between  the  phase  of  the 
tracking  filter  and  a  value  of  the  phase  formulated  on  the 
time  updated  position  of  the  combinational  filter.  Based  on 
this  measurement,  the  combinational  filter  derives  estimates 
of  position  errors,  velocity  errors,  oscillator  start  time 
and  oscillator  drift. 

Eecause  the  Omega  navigation  system  functions 
with  several  distinct  velocity  sensors  (ie.  inertial, 
doppler,  or  air  data) ,  a  different  mode  of  operation  exists 
for  the  combinational  filter  for  each  sensor.  Each  method 
requires  the  filter  to  estimate,  predict,  and  control  a 
different  set  of  system  errors.  Each  set  of  system  errors 
conforms  to  the  dead  reckoning  velocity  source  used  for  time 
updating. 

The  combination  of  uncertainties  in  position 
error  and  receiver  oscillator  start  time  produces  a 
vagueness  of  the  number  of  wave  lengths  or  lanes  between  the 
transmitting  station  and  the  receiver.  This  ambiguity  occurs 
primarily  when  the  system  is  first  initialized.  To  find  the 
solution  to  this  lane  ambiguity,  several  estimates  of  the 
state  vector,  X(i) 's,  are  calculated  by  the  filter.  These 
X(i)'s  correspond  to  the  different  possible  lanes  or 
integral  values  of  phase  measurement.  As  measurements  are 
acquired,  corresponding  to  the  three  frequencies,  the 
uncertainity  in  oscillator  start  time,  t© ,  is  diminished. 
Measurements  from  different  stations  tend  to  minimize  the 
position  uncertainity.  The  general  effect  is  a  reduction  in 
the  number  of  state  vector  estimates,  X  (i)  's,  that  can  be 
considered  logical  estimates  of  the  most  accurate  state 
vector  until  only  one  credible  estimate  remains.  The 
criterion  for  reasonableness  is  based  on  variance 
considerations. 
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b.   Operation 

There  are  three  distinct  operations  identified 
with  the  combinational  filter  routine. 

1)  Initialization 

2)  Time  update 

3)  Measurement   update 

The  initialization  operation  assigns  the  initial 
values  of  variance  to  the  covariance  matrix  P,  sets  the 
elements  cf  the  initial  state  vector  to  zero,  and  sets  the 
system   driving  noises  as  a  function  of  the  velocity  source. 

In  the  time  update  operation,  both  the  state 
vector  X,  and  the  covariance  matrix  P,  are  predicted  from 
the  last  update.  The  following  equations  are  utilized  in 
the  time  update  operation. 

Xnew  =  $new  *  Xold 

Pnew  =  |new  *  Pold  *  $new  +  Nnew 

The  transition  matrix  $.[6  x  6]  mathematically  expresses  the 
propagation  of  errors  across  the  time  interval  A  t  since  the 
last  update.  The  elements  of  the  transition  matrix  are 
shewn  in  the  following  chart. 
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here  fli  (i=I,D,  or  A)  signifies   the   inverse   correlation 
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time  of  dVC2  and  6VC3  for  the  velocity  source  mode  utilized. 
The  transition  matrix  $  furnishes  the  propagation  of  the 
predicted  elements  of  the  state  vector  X  and  the  covariance 
matrix  P  across  the  time  interval  A  t.  The  variance  effects 
across  this  time  interval  are  propagated  by  the  additive 
^diagonal  ncise  matrix  N  [6  x  6].  The  following  chart  depicts 
the  elements  of  the  noise  matrix  N. 
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where  £i  is  the  inverse  correlation  time  described 
previously,  and  o~  2i  is  the  variance  of  the  velocity  errors 
(oVC2  and  0VC3)  and  is  dependent  on  velocity  source  utilized 
(i=I,D,  or  A) . 

During  the  time  update  operation,  the  multiple 
state  vectors,  X  (i)  ' s,  which  exist  until  the  correct  lane 
has  been  determined  must  also  be  time  updated.  The  time 
update  equation  for  the  state  vector  X  must  be  sequenced 
through  all  state  vectors. 

X  (i)  new  =  |new  *  X  (i)  old     for  all  i 

The  covariance  matrix  time  update  equation  is  computed  once, 
because  there  is  only  one  covariance  matrix  regardless  of 
the  number  of  state  vectors. 

After  completion  of  the  time  update  operation 
and  prior  tc  the  measurement  update  operation,  the 
measurement  residual,  (RES),  measurement  matrix,  M,  and  the 
measurement  confidence  scalar,  C,  are   calculated   for   each 
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tracking  filter  input.  The  measurement  residual  and 
measurement  matrix  calculations  were  previously  explained  in 
the  section  describing  the  combinational  filter.  The 
measurement  confidence  scalar,  C,  is  a  measurement  of  noise 
computed  by  the  following  equation. 

C  =  <r  20PROP  +  o-  2(J>TRK 

where  o~  24>PROP  and  <r  20TRK  are  the  variance  of 
the  propagation  prediction  phase  estimate  and  the  tracking 
filter  phase  measurement. 

The  measurement  update   operation  involves  the 

generation   of   a   linear,   unbiased  weighting  vector  b,  and 

computation  cf  a  new,  minimum  variance,  state  vector  X  by 
the  formula  listed  below. 

Xnew  =  Xold  +  b  *  (RES) 

To  generate  the  optimum  weighting  vector,  b,  three 
expressions  are  required. 

1)  the  predicted  measurement  variance  -  M*P*M 

2)  the  measurement  confidence  scalar  -  C 

3)  the  divergence  control  factor  -  €   (epsilon) 

The  weighting  vector  is  calculated  from  the  following 
equations. 

Q  =  M*P*MT  +  C 

b  =  (P*MT  +  £"MT)  /  Q 

where  Q  is  defined  to  be  a  scalar  quantity  depicting  the 
lane  variance,  and  €  is  a  factor  to  prevent  divergence  of 
the  estimation  process.  Also  updated  in  the  measurement 
update   process  is   the   covariance   matrix   based   on   the 
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following  formula. 


Pnew  =  Pold  -  b  *  M  *  Pold  +  e  *  M   *  bT 


Th€  retention  of  new  state  vectors  is  predicated  on  the 
testing  cf  the  position  elements  in  the  state  vector,  and 
the  variance  values  in  the  covariance  matrix. 

7«   Propagation  Prediction 

In  order  to  effectively  resolve  the  aircraft 
position  frcm  the  phase  information  received,  the  phase 
velocity  of  the  wave  along  the  propagated  path  and  the 
length   of   the   path   must   be   known.    Several  factors  or 

* 

effects  create  imperfections  in  the  wave  guide  through  wnich 
the  VLF  signals  propagate.  The  propagation  prediction 
function  establishes  the  best  estimate  of  phase  and  phase 
variance  taking  into  account  the  factors  listed  below  which 
effect  the  phase  velocity  of  the  propagated  signals. 

a.  Diurnal  Effects 

The  positional  changes  of  the  sun  over  the  earth 
adjust  the  size  and  the  shape  of  the  ionosphere.  The  change 
of  the  wave  guide  through  which  the  VLF  signals  propagate 
causes  a  change  in  the  velocities  of  the  phase  signal  which 
results  in  a  difference  in  phase  angle  received  at  the  Omega 
receiver  location. 

b.  Ground  Conductivity 

This  factor  takes  into  account  the  effect  of 
various  mediums  over  which  VLF  signals  travel.  Water,  which 
is  a  near  perfect  conductor  of  VLF  signals,  does  not  greatly 
affect  the  signals.  Land,  which  is  a  less  perfect  conductor 
of  VLF  signals,  does  affect  the  signals  to  a  greater  extent. 
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Conductivity  patterns  have  been  measured  and  are  predictable 
[Ref.  6]. 

c.  Earth's   Magnetic    Field 

This  factor  affects  both  the  attenuation  rate 
and  the  velocity  of  the  signal.  The  phase  shift  on 
refraction  of  the  VLF  signal  off  of  the  ionosphere  depends 
on  the  interaction  of  the  signal  with  the  electrons,  and 
this  depends  on  the  orientation  of  the  magnetic  field  with 
respect  to  the  direction  of  propagation  and  on  the  magnitude 
of  the  field  [Ref.  12  ]. 

d.  Latitude  and  Spheroidal  Effects 

This  factor  takes  into  account  the  nonspherical 
shape  of  the  earth  and  the  adjusted  path  of  travel  from  the 
transmitting  station  to  the  Omega  receiver. 

e.  Polar  Cap  Absorption  (PCA) 

VLF  signals  which  pass  over  the  Polar  Cap 
experience  an  abnormal  rate  of  absorption  during  both  day 
and  night.  PCA  produces  large  changes  in  VLF  signal  patterns 
which  can  last  for  several  days. 

f.  Sudden  Ionospheric  Disturbance  (SID) 

Sclar  flares  emanating  on  the  sun's  surface 
increase  the  ionization  within  the  atmosphere.  These  SID's 
cause  large  changes  in  the  phase  of  VLF  signals  passing 
through  the  area  of  activity. 

Of  the  six  factors  which  affect  the  propagation  of 
VLF  signals,  the  first  four  are  predictable  and  can  be 
compensated  for  algorithmically,  while  the  last  two  are 
unpredictable  and  cannot  be  compensated  for  within  an  Omega 
navigation  system. 
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IV.   VELOCITY  AND  NAVIGATION  PROCESSING  FUNCTION 


The  velocity  and  navigation  processing  function  is 
divided  into  two  routines  in  the  Omega  navigation  system. 
The  velocity  processing  routine,  utilizing  the  current 
navigational  source  (ie.  inertial,  doppler,  or  air  data), 
calculates  the  velocities  along  the  system  axes  frcm  the 
available  source  velocities.  These  system  axes  velocities, 
combined  with  the  state  vector  corrections  from  the 
combinational  filter,  are  supplied  to  the  navigation  routine 
in  order  to  update  the  Omega  system  position  matrix  and  the 
Omega  aircraft  latitude  and  longitude  position. 


A.   VELOCITY  PROCESSING 


In  the  velocity  processing  routine,  the  aircraft  current 
true  airspeed  velocity  (VTAS)  and  heading  (ACHDG)  ,  the 
current  wind  direction  (WD)  and  velocity  (VW) ,  and  the 
dopplers  current  velocity  components  along  heading  (VDA)  and 
across  heading  (VDC)  are  utilized  to  compute  the  velocities 
in  the  North/South  and  East/West  directions  from  the 
following  eguations, 

VEN  =  VDA  *  CDS  (ACHDG)  -  VDC  *  SIN  (ACHDG) 

VDE  =  VDC  *  COS  (ACHDG)  +  VDA  *  SIN  (ACHDG) 

VAN  =  VTAS*  COS  (ACHDG)  +  VW  *  COS  (WD) 

VAE  =  VTAS*  SIN  (ACHDG)  +  VW  *  SIN  (WD) 

where  VDN  and  VDE  signify  doppler  velocities  North/South  and 
East/West,   and   VAN   and   VAE   signify   air  data  velocities 
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North/South  and  East/West  respectively.  In  constructing  the 
data  flow  graph  of  these  equations,  it  was  self-evident  that 
some  variables  could  be  calculated,  stored  in  memory,  and 
retrieved  from  memory  when  they  were  required  in  later 
calculations.  Figure  12  depicts  the  data  flow  graph  for  the 
North/South  and  East/West  computations.  Implementing  PL/M 
code  directly  frcm  this  data  flow  graph  was  straight 
forward. 

On  completion  of  the  North/South  and  East/West 
velocities  computations,  a  test  is  made  in  the  velocity 
processing  function  to  determine  if  the  navigation  mode  has 
changed  since  the  last  iteration  of  the  velocity  function. 
If  an  upgrade  of  the  navigation  mode  has  occurred  (ie. 
doppler  to  inertial,  or  air  data  to  doppler  or  inertial) , 
then  the  summations  (DELVC2  and  DELVC3)  of  the  corrections 
to  the  system  velocity  components  from  the  combinational 
filter  are  set  equal  to  zero,  and  new  velocities  along  the 
system  axes  are  calculated.  Figure  13  depicts  the 
navigation  mode  test  and  applicable  equations  for  computing 
the  system  axes  velocities. 

In  order  to  save  execution  time  in  the  calculation  of 
the  formulas  and  to  simplify  the  PL/M  code,  the  functions 

(ViE  *  COS(SHDGA)  +  ViN  *  SIN  (SHDGA)  ) 
(ViN  *  COS(SHDGA)  -  ViE  *  SIN  (SHDGA)  ) 

were  calculated  prior  to  the  navigation  mode  test.  Figure  14 
depicts  the  data  flow  graph  for  these  two  functions.  After 
successful  computation  of  the  above  functions  and  the 
navigation  mode  test,  the  corrected  velocities  (VC2  and  VC3) 
along  the  system  axes  are  calculated  and  the  resultant 
values  used  in  the  navigation  routine. 
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B.   NAVIGATION  PROCESSING 


In  the  navigation  processing  routine,  the  Omega  system 
position  matrix  R  [3  X  3]  is  initialized,  the  angular 
rotations  (DELT2  and  DELT3)  about  the  .  system  axes  are 
calculated  using  the  corrected  velocities  supplied  by  the 
velocity  processing  routine  and  the  state  vector  corrections 
from  the  combinational  filter,  the  system  position  matrix  is 
updated,  and  a  new  Omega  aircraft  latitude  (OLATAC)  and 
longitude  (OLONAC)  are  calculated.  The  flowchart  of  the 
navigation  routine  is  shown  in  Figure  15. 

The  initialization  of  the  Omega  system  position  matrix  R 
occurs  during  the  initialization  function  when  the 
Navigator/Communicator  inserts  the  aircraft  initial  latitude 
(OLATIN)  and  longitude  (OLONIN) .  These  values,  with  an 
initial  condition  that  the  system  heading  angle  (SHDGA)  is 
zero,  are  input  to  the  equations  listed  below. 

R11  =  SIN  (OLATIN) 

R12  =  CCS(OIATIN)  *  COS  (OLONIN) 

R13  =  COS(OLATIN)  *  SIN(OLONIN) 

R21  =  COS  (OLATIN)  *  SIN  (SHDGA)   =  0 

R22  =  -SIN  (OLONIN)  *  COS(SHDGA)  - 

SIN  (OLATIN)  *  COS  (OLONIN)  *  SIN  (SHDGA) 
=  -SIH(CIONIH) 

R23  =   COS  (OLONIN)  *  COS  (SHDGA)  - 

SIN(CLATIN)  *  SIN  (OLONIN)  *  SIN  (SHDGA) 
=   COS(CICNIN) 

R31  =   COS  (OLATIN)  *  COS  (SHDGA)  =  COS  (OLATIN) 
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R32  =   SIN (OLONIN)  *  SIN(SHDGA)  - 

SIN(OLATIN)  *  COS(OLONIN)  *  COS(SHDGA) 
=  -SIN(CLATIN)  *  COS  (OLONIN) 

R33  =  -COS(CLONIN)  *  SIN(SHDGA)  - 

SIN(CLATIN)  *  SIN(OLONIN)  *  COS(SHDGA) 
=  -SIN  (OlATIN)  *  SIN  (OLONIN) 

These  nine  equations  represent  nine  direction  cosine  values. 
These  values  represent  the  orientation  of  each  of  the  three 
system  axss  (R1,  R2,  and  R3)  in  the  earth's  fixed  coordinate 
frame.  In  constructing  the  data  flow  graph  for  the 
initialization  equations,  the  concept  of  mininizing 
execution  rime  prevailed,  and  as  variables  were  calculated, 
they  were  stored  in  memory  and  retrieved  as  they  were 
required  in  later  calculations.  Figure  16  portrays  the  data 
flew  graph  icr  the  initialization  of  the  position  matrix   R. 
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FIGURE    15   -      NAVIGATION    PROCESSING   FLOWCHART 
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After  completing  the  initialization  phase,  the 
navigation  function  calculates  the  angular  rotations  (DELT2 
and  DELT3)  atout  the  system  axes  R2  and  R3.  The  following 
equations  are  used  in  calculating  the  angular  rotations. 

DELT2  =  -[  1  +  EEC  *  (2  *  R312  -  R112)  ]  *  VC3  *  DTNAV  -r 

EMER 
2  *  EEC  *  R21  *  R31  *  VC2  *  DTNAV  +  S(J)3 

EMER 

DELT3  =   [1  +  EEC  *  {2  *  R212  -  R112)  ]  *  VC2  *  DTNAV  + 

EMER 
2  *  EEC  *  R21  *  R3  1  *  VC3  *  DTNAV  -  £(})2 

EMER 

As  in  previous  equations,  converting  to  data  flow  graphs  was 
accomplished  with  the  idea  of  minimizing  execution  time. 
Figure  17  is  the  data  flow  graph  constructed  from  the  above 
equations.  Once  the  angular  rotations  are  calculated,  the 
position  matrix  is  updated  based  on  the  formula 


[R]new  =  [RJold  +  [4)]  *  [RJold 

where  [  (J)  ]  is  the  rotation  update  matrix  given  below. 

-(DSLI22  ♦  DELT32)        DELT3  -DELT2 
2 

-DELT3            - (DELT3)  DELT2  *  DELT3 

2  2 

DE1T2         DELT2  *  DELT3  -  (DELT2) 


Simplification  of  the   position   matrix   update   formula   is 
accomplished  utilizing  the  following  equations. 
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A(j)  =  R1j  +  H2j  *  (DELT3  /  2)  -  R3j  *  (DELT2  /  2) 
3  =  [  (DELT2)  2  +  (DELT32)  ]  /2 

The  position  matrix  update  equations  are  then  written  in  the 
following  format. 

R1j  =  R1j  -  R1j  *  B  +  R2j  *  DELT3  -  R3j  *  DELT2 
R2j  =  R2j  -  DELT3  *  A ( j) 
R3j  =  R3j  +  DELT2  *  A (j) 

Implementation   of   these   equations  in  a  data  flow  graph  is 
depicted  in  figure  18. 

Once  the  position  matrix  R  is  updated,  the  last 
equations  to  calculate  are  for  updating  the  system  heading 
angle  and  the  aircraft  new  latitude  and  longitude.  The 
equations  listed  below  update  these  thre.e  system   variables. 

SHDGA  =  A5CTAN  (R21  /  R31) 

OLATAC  =  AP.CTAN  [(R11  *  COS(SHDGA))  /  R31] 

OLOJAC  =  ARCTAN  (R13  /  R12) 

The  data  flow  graph   presented   in   Figure   19   depicts  the 
update  of  these  system  parameters. 
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From  the  data  flow  graphs  of  the  velocity  and  navigation 
function,  four  PL/M  floating  point  subroutines  were  written. 
The  subroutines  consist  of  an  initialization  (INITIALIZES!*) 
routine  for  initializing  the  position  matrix  R,  a  velocity 
processing  (VELPROC)  routine  for  computing  the  velocities 
along  the  system  axes,  a  navigation  processing  (NAVPROC) 
routine  for  calculating  the  angular  rotations  about  the 
system  axes,  and  a  new  position  (NEWPOS)  routine  for 
updating  the  position  matrix  R,  aircraft  system  heading 
angle,  and  aircraft  latitude  and  longitude.  Based  on  the 
arithmetic  and/or  trigonometric  functions  used  in  the  data 
flow  graphs  and  an  approximation  of  the  time  required  to 
execute  each  function,  a  preliminary  estimate  of  the  time 
required  to  execute  each  subroutine  was  acquired.  Utilizing 
INTERP/80,  which  is  the  FORTRAN  IV  software  simulation  of 
the  INTEL  8080  CPU  and  is  available  on  the  IBM  360/67,  the 
actual  execution  time  of  each  program  was  acquired.  The 
following  chart  shows  the  number  of  arithmetic  functions 
used  in  each  subroutine,  the  estimated  and  actual  execution 
times  in  milliseconds  of  the  subroutines,  and  the  storage 
utilized  for  each  subroutine. 
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From  the  last  three  subroutines,  it  is  seen  that  the  total 
execution  time  of  562.5  milliseconds  is  between  two  and 
one-half  and  three  times  as  great  as  the  200  millisecond 
time  interval  currently  implemented  in  the  P-3C.  However, 
because  the  Omega  navigation  display  for  Omega  latitude  and 
longitude  is  updated  every  second,  the  microcomputer 
subroutines  are  capable  of  providing  an  update  in  sufficient 
time  to  be  displayed  on  the  Omega  tableau. 

In  the  simulated  test  case  used  to  check  the  validity  of 
the  subroutines,  a  navigation  cycle  time  (DTNAV)  of  1  second 
was  used  in  the  computations.  This  1  second  time  interval 
allowed  an  aircraft  traveling  at  300  knots  to  be  updated  at 
approximately  every  506  feet.  The  velocity  processing 
routine  was  able  to  calculate  the  velocities  along  the 
system  axes,  using  the  PL/M  floating  point  function,  to  four 
digit  accuracy  (ie.  from  000.0  feet  per  second  to  999.9  feet 
per  second) .  These  velocities  encompass  the  complete  range 
of  the  P-3C  airspeed  capabilities. 

The  calculations  performed  in  the  remaining  subroutines 
presented  problems  when  using  the  PL/M  floating  point 
functions.  Eecause  the  functions  utilize  a  16  bit  mantissa, 
the  exponent  values  have  to  be  within  a  range  of  216  when 
adding  or  subtracting  two  numbers.  Because  the  difference 
between  the  calculated  angular  rotations  about  the  system 
axes  and  the  direction  cosine  values  in  the  position  matrix 
is  not  within  this  range,  several  angular  rotations 
calculated  ever  time  had  to  be  added  together  before 
updating  of  the  position  matrix  R  could  be  accomplished. 
This  is  the  major  difficulty  with  the  subroutines 
implemented  with  the  present  PL/M  floating  point  routines. 
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V.   CONCLUSION 


Based  on  the  subroutines  implemented  for  the  velocity 
and  navigation  function,  a  microcomputer  is  capable  of 
calculating  the  required  system  parameters  in  sufficient 
time  and  with  sufficient  accuracy  to  provide  reliable 
position  fixing  information.  Even  with  the  microcomputers 
primary  disadvantage  of  slower  execution  time,  the  position 
fixing  information  could  be  displayed  at  one  second 
intervals  provided  a  floating  point  package  which  operated 
with  a  mantissa  of  24  bits  could  be  acquired.  Further 
research  of  the  remaining  internal  functions  and  the  overall 
effect  they  have  on  the  velocity  and  navigation  function  is 
encouraged.  Particular  attention  should  be  focused  en  the 
state  vector  elements  applied  to  the  velocity  and  navigation 
equations,  and  their  relevance  to  overall  system  operation 
and  update  of  position  information. 
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CECLARE  11  ACCRESS,  ZE  BYTE; 

/* 

THE  ABCVE  VARIABLES  ARE  GLOBAL 
TO  THE  FLOATING  PCINT  SUBROUTINES 
*/ 

ERRCF:  FRCCEDURE <  I ) ; 

/* 

PRCCECLRE  TO  PROVIDE  ERROR  MESSAGES 
FOLLOWED  BY  TERMINATION  CF  PROGRAM  EXECUTION 
*/ 

DECLARE  I  3YTE; 
CALL  CPLF; 

CC  CASE  I; 

/* 

MESSAGE  FOR  UNDERFLOW 

*/ 

CALL  PRINK. 'EXECUTION  TERMINATEC  DUE  TO  UNDERFLOWS  '  )  ; 

/* 

MESSAGE  FOR  OVERFLOW 

*/ 

C^LL  PRINK  .'EXECUTION  TERMINATEC  DUE  TO  OVERFLOWS'); 

/* 

MESSAGE  FOR  ERROR  IN  LOG- ARGUMENT 

*/ 

CALL  PRINT(  .'ARGUMENT  FOR  LOG  NEGATIVE  OP  1ERC$'  )  ; 

/* 

MESSAGE  FOR  ERROR  IN  DIVISION 

*/ 

CALL  PRINK  .'ATTEMPTED  DIVISION  BY  ZEROS'); 

/* 

MESSAGE  FOR  INPUT  ERROR 
*/ 

CALL  PRINK  .'INPUT  ERRORS'); 

MESSAGE  FOR  EXP(X)  OVERFLOW 

*/ 

CALL  PRINK  .'OVERFLOW,  ARGUMENT  FOR  EXP(X)  TCC  BIGS'); 

END; 

HALT; 
RETURN; 
END  EPRCR; 

/* 

FLCATINC-  PCINT  ACD  ROUTINE 
*/ 

ADD:  FPCCEDURE  (XA,YA,PA); 

CECLARE  XA  ACCRESS,  X  3ASED  XA  BYTE, 

YA  ACCRESS,  Y  BASED  YA  BYTE, 

PA  ADDRESS,  P  BASED  PA  3YTE, 

(DIFF, I,SIGN,XEX,YEX)  BYTE, 

(XX, YY)  ADDRESS; 
CECLARE  POSITIV  LITERALLY  '<  80H', 

NEGATIV  LITERALLY  »=80H«; 
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PROCEDURE  TC  LEFT  JUSTIFY  MANTISSA,  DECREMENTING  EXPONENT 
*/ 

ACJUST:  PROCEDURE; 
DC  1=1  TC  16; 

IF  (ZZ  AND  800CH)=8000H  THEN  RETURN; 

ZZ  =  SHL(ZZ,1)  ; 

P(2)  =  (ZE  :=  F(2)  -  1); 

/* 

CHECK  FOR  UNDERFLOW 
*/ 

IF  (F(2)  AND  07FH)  =  0  THEN 

CALL  ERROR(O); 
END; 

RETURN; 
ENC  ACJUST; 

/* 

BRIK     ECTH    MANTISSAS    AND    EXPONENTS     IN    WORKING    AREA 
*/ 

XX  =  SHL(DCUBLEtX) ,8)  OR  X(l); 
YY  =  SFL(DCUBLE(Y) ,8)  OR  Y(l); 
XEX  =  X12)  AND  07FH; 
VEX  =  Y(2)  AND  07FH; 

/* 

CHECK  MANTISSAS  TO  SEE  IF  ZERO 
*/ 

IF  OX  =  OCOOH)  THEN  DC; 

11        =  yy; 

P(2)  =  (ZE  :=  Y(2) ); 

GC  TO  RET; 
ENC; 

IF  (YY  =  OCOOH)  THEN  DO; 
2  2    =  XX  * 
P  (2)  =  (ZE  :=  X(2)  ); 

GC  TO  RET; 
END; 

/* 

CALCULATE  DIFFERENCE  BETWEEN  EXPONENTS  AND  CHECK  SIGN 

*/ 

CIFF  =  XEX  -  YEX; 

IF  (CIFF  AND  C60H)  <>  0  THEN 

CIFF  =  -  DIFF; 
SIGN  =  (X(2)  AND  080H)  XOR  (Y(2)  AND  080H); 

CHECK  IF  OPERATION  BEYOND  SIGNIFICANCE 
*/ 

IF  (CIFF  >=  16)  THEN  CO; 
IF  (XEX  >  YEX)  THEN  DO; 

zz  =  xx; 

P     =  HIGH(ZZ); 

P(l)  =  LCW(ZZ); 

P(2)  =  (ZE  :=  XEX); 

END; 
ELSE  DC; 

ZZ  =  YY; 

P     =  HIGH(ZZ); 

F(l)  =  LCW(ZZ)  ; 

P(2)  =  (ZE  :=  VEX); 

END; 
RETURN; 
END; 
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IF  XEX  =  YBX  THEN  DO; 

/* 

EXFCNEMS  ARE  EQUAL 

*/ 

IF  XX  >  YY  THEN  DC; 

/* 

CFERAND  1  >  OPERAND  2 
*/ 

P(2)    =    (ZE    :=    X(2)); 

IF    SIGN    FOSITIV    THEN 

GC    TO    EXITl; 
GO    TC    EXIT2; 
END; 

IF    YY    >    XX    THEN    DO; 

/* 

CFERAND    2    >    OPERANC    1 
*/ 

P(2)  =  (ZE  :=  Y(2))  ; 

IF  SIGN  FOSITIV  THEN 

GC  TO  EXITl  ; 
GO  TC  EXIT3; 
END; 

/* 

OPERAND  1  =  OPERAND  2 

IF  SIGN  POSITIV  THEN  DO; 
P(2)  =  ( ZE  :=  X(2) ) ; 

GO  TO  EXITl; 
END; 

/* 

RESULTING  ZERO  FROM  EQUAL  NUMBERS  WITH  DIFFERENT  SIGN 
*/ 

ZZ  =  XX  -  YY; 

P     =  HIGH(ZZ)  ; 

P (1)  =  LOW(ZZ) ; 

P (2)  =  (ZE  :=  OOOF) ; 

RETURN; 

ENC; 

IF  XEX  >  VEX  THEN  DO; 

/* 

EXPONENT  CF    OPERAND  1  >  EXPONENT  OF  OPERAND  2 
*/ 

P(2)  =  (ZE  :=  X(2)  )  ; 

YY    =    SHR( YY,DIFF ) ; 
IF    SIGN    POSITIV    THEN 

GO    TC    EXITl; 
GC    TO    EXIT2; 
END; 

/* 

EXFCNENT  CF  OPERAND  2  >  EXPONENT  OF  OPERAND  1 

F(2J  =  (ZE  :=  Y(2) ) ; 

X>  =  SFR(XX,DIFF) ; 
IF  SIGN  POSITIV  THEN 

GC  TO  EXITl ; 
ELSE 

GC  TO  EXIT3; 
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/* 

ACD  TWO  OPERANCS  WITH  EQUAL  SIGN 
*/ 

SXIT1: 

22  =  XX  +  Y  Y  * 

IF  (CARRY)  THEN  DO; 

11    =  SCP(ZZ,1) ; 

ZE  =  ZE  +  l; 

/* 

AC-JUST  EXPONENT  AND  CHECK  FOR  OVERFLOW 
*/ 

IF  {PiZ)    POSITIV)  THEN  DO; 

P(2)  =  ( ZE  :=  P(2)  +  1) ; 

IF  (P{2)  AND  080H)  <>  0  THEN 
CALL  ERROR(l); 

END; 
ELSE  DO; 

P(2)  =  (ZE  :=  P(2)  +  1); 

IF  (CARRY)  THEN 
CALL  ERROR(l); 

END; 
END; 

GC  TC  RET; 

/* 

ACC  CPERANCS  WITH  DIFFERENT  SIGN 
*/ 

EXIT2  : 

ZZ  =  XX  -  YY; 
CALL  ACJLST; 
GC  TC  RET; 

EXIT3: 

ZZ  =  YY  -  xx; 

CALL  ADJUST; 

/* 

4SSIGN  RESULTING  MANTISSA  VALUES 
*/ 

PET: 

P     =  HIGH(ZZ); 

P(l )  =  LOW (ZZ)  ; 

3ETLFN; 
ENC  ADC; 

/* 

FLCATING  PCINT  SUBTRACT  ROUTINE 
*/ 

SUB:  PRCCEDURE  IXA,YA,PA); 

DECLARE  XA  ADCRESSt  X  BASED  XA  BYTE, 

YA  ADDRESS,  Y  BASED  YA  BYTE, 

PA  ADDRESS,  P  BASED  PA  BYTE, 

NEGY  (3)  EYTE; 

/* 

CHANGE  SIGN  OF  OPERAND  2  AND  CALL  ACC  ROUTINE 
*/ 

NEGY     =  V; 
NEGY (1)  =  Y(l)  ; 

NEGY (2  )  -  Y(2 )  XOR  080H; 
CALL  ADD(XA,.NEGY, PA  )  ; 

enc  sue; 
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/v. 

FLOATING    POINT    MLLTIPLY    ROUTINE     INCLUCING 
OPTICN    FOR    HARDWARE    MULTIPLY    OF    MANTISSA 
*/ 

CECLARE     <MO$SLOT,ND$OPTICN)    BYTE    INITIAL    (0); 

MULT:  PFOCEDUPE(XA,YA,PA); 

CECLARE  XA  ADDRESS,  X  BASED  XA  BYTE, 

YA  ADDRESS,  Y  BASED  YA  BYTE, 

PA  ADDRESS,  P  BASED  PA  BYTE, 

I  BYTE,  (CP1,  0P2)  ADDRESS; 

/* 

CHECK  FOR  ZERO  OPERANC 
*/ 

IF  (>=0)  CR  (Y=0)  THEN  DO; 
/* 

IF  FCUND,  RETURN  ZERC  AS  RESULT 

P  (C)  =  OOOH; 
F(l  )  =  OOJH; 
P(2I  =  COOH; 
RETURN; 
ENC; 

/* 

HARChARE  OR  SOFTWARE  MANTISSA 
*/ 

CC  CASE  MDJGPTION; 

/* 

CASE  0  -  SOFTWARE  MULTIPLY 
*/ 

DC; 

/=* 

BRHG  3CTH  MANTISSAS  IN  OPERAND  FIELDS 

*/ 

ZE  =    SHR<    X(l),     l); 

CF1  =    SHL(C0UBLE(X),7); 

CF1  =    CP1     CR    ZE; 

CF2  =    SHL(COUBLE (Y),8); 

CF2  =    CP2    CR    Y(l)  ; 

/* 

THE  MULTIPLICATION  OF  THE  MANTISSAS  IS  DONE  IN 
HAPCWARE-LIKE  FASHION  BY  SHIFTING,  COPYING  ANC 
ACCING  CF  OPERAND  1  FOR  EVERY  1  FCUND  IN  CPER- 
£NC  2;  £ND  EY  SHIFTING  ONLY  FOR  EVERY  0  FCUND 
IN  OPERAND  2,  STARTING  WITH  THE  LEAST  SIGNIFI- 
CANT 1 
*/ 

/* 

INITIALIZE  WORKING  FIELC 
*/ 

ZZ  =  o; 

ZE  =  0; 

/* 

SHIFT    OPERAND    2    BIT    BY    BIT    THROUGH    CARRY    AFTER 
SHIFTING    OF    ADDED    RESULTS     IN    WORKING    FIELD    HAS 
BEEN    DONE 
*/ 
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DC  1=0  TC  15  BY  l; 
ZZ   =  SCRtZZ, 1 ) ; 
CP2  =  SCR(0P2,  1)  ; 


/  * 

CHECK  IF  A 

*/ 


1  HAS  BEEN  SHIFTED  INTO  THE  CARRY 


IF  (CARRY)  THEN  DO; 

/* 

IF  YES,  ADD  OPERAND  1  TO  THE  CONTENTS  OF  THE 

WORKING  AREA 

*/ 


11    =    11 
END; 
END; 


+  CFl; 


/* 

NORMALIZE, 
*/ 


IF  NEECED 


IF  (ZZ  <  80C0H)  THEN  DO; 
11    =  SHL(ZZ, I)   ; 

/* 

SET  ADJUSTMENT  FCR  EXPONENT 
*/ 


ZE  =  -1 ; 
END; 
EI\C;    /*  CASE 


C£SE 


0  */ 

H4RCWARE  MULTIPLY,  SLOT  0 


C  C  * 

OLTPUT( C)  =  X(l) ; 

CLTPUTt 1)  =  X; 

CLTPUT(2)  =  Y(l) ; 

OLTPUTO)  =  Y; 

ZZ  =  SHL(DCUBLE(INPUT(3)),8)  +  DOUBLE ( INPUT ( 2 )) ; 

IF  (ZZ  AND  8000H)  =  0  THEN  DO; 

I  =  SCL(  INPUTt  1),1)  ; 

ZZ  =  SCL  (ZZ,1)  ; 

ze  =  -i; 

END; 
ELSE 

ZE  =  0; 
END;    /*  CASE  1  */ 

/* 

CASE  2  -  HARCWARE  MULTIPLY,  SLOT  1 
*/ 

C  C  * 

OLTPUTt  C4H)  =  X( 1 ) ; 
CUTPUT(05H)  =  X; 
CLTFUT(C6H)  =  Yd); 
CLTPUT(07H)  =  Y; 
ZZ  =  SHL(DCUBLE(INPUT(07H)) ,8) 
IF  (ZZ  AND  8000H)  =  0  THEN  DO; 
I  =  SCL(INPUT(C5H) ,1); 

zz  =  scl(zz,i ) ; 
ze  =  -i; 

END; 
ELSE 

ze  =  o; 

ENC;    /*  CASE  2  */ 


+  COUBLE  (  INPLK06H)  )  ; 
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/* 

CASE  3  -  HARDWARE  MULTIPLY,  SLOT  2 
*/ 


DC; 

CUTPUT(08H) 
CUTPUK09H) 
OLTPUT(CAH) 
CUTPUT(OEH) 


X(i); 

x; 

Y(l); 

Y; 

ZZ  =  SHL(DCUBLE(INPUT(08H))  ,8) 
IF  ill    AND  eOOOH)  =  0  THEN  DO; 

I  =  SCL(  INPUK09H)  ,  1)  ; 

II  =  SCL(ZZ»L ) ; 
ZE  =  -l; 

END; 
ELSE 

ZE  = 
END; 


+  CCUBLE (  INPLT(OAH)  )  ; 


0; 
/*  CASE  3  */ 


CASE  4  -  HARDWARE  MULTIPLY,  SLOT  3 
*/ 


C  C  * 

CLTPUT(OCH)  =  X(l )  ; 

CLTPUT(CDH)  =  X; 

CUTPUT(OEH)  =  Y( 1) ; 

COTPUT(OFH)  =  Y; 

11    =  SHL(OOUBLE(INPUT(OFH) )  ,8) 

IF  (ZZ  ANC  8000H)  =  0  THEN  DO; 

I  =  SCL(  INPUT(OCH) ,1) ; 

II  =  SCL(ZZ,1)  ; 
ZE  =  -15 

END; 
ELSE 

ZE  =  3  * 
END;    /**CASE  4  */ 
END;       /*  CASE  I  STATEMENT  */ 


+  CCUBLEt  INPUT (OEHJ  ); 


SLV  LP  EXPCNENTS  AND  ADJUSTMENT 
*/ 

P(l)  =  (X(2)  AND  7FH)  +  (Y(2)  AND  7FH)  ; 
F(2)  =  P(l )  +  ZE  -  64; 

/* 

CHECK  FOR  CVERFLOW  AND  UNCERFLOW 

IF  (CARRY)  THEN 

CALL  ERROR(C) ; 
IF  (P(2)  ANO  J80H)  <>  0  THEN 

CALL  ERROR(  1) ; 

/* 

SET  SIGN  BIT 

P(2)  =  P(2)  OR  ((X(2)  AND  080H)  XOR  (Y(2)  AND  C8CH)); 

/* 

ASSIGN  MANTISSA  VALUES 

P     =  HIGH(ZZ); 
F(l)  =   LCW(ZZ); 

retufn; 

END  VULT; 
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/* 

FLOATING  POINT  CIVIDE  ROUTINE  INCLUDING  DIVIDE  BV  HARDWARE 
*/ 

DIV:  PFCCECURE(XA,YA,PA); 

DECLARE  >A  ADDRESS,  X  BASED  XA  3YTP, 

YA  ADDRESS,  Y  3ASED  YA  BYTE, 

PA  ADDRESS,  P  BASED  PA  BYTE, 

(OP1,  OP2,  DIFF)  ADDRESS, 

I  BYTE,  C  (3)  BYTE; 

/* 

BRING  BOTH  MANTISSAS  IN  OPERAND  FIELC 
*/ 

CFi  =  SHL(CGUBLE(X) ,8)  OR  X(l); 
CP2  =  SHL(D0U3LE(Y) ,8)  CR  Y(l); 

/* 

CHECK  FOR  ZERO  IN  OPERAND  1 
V 

IF  X  =  0  THEN  DO; 

/* 

IF  FCLND  RETURN  ZERO  AS  RESULT 
*/ 

P(C)  =  COOH; 
P  (1  )  =  COOH; 
F(2)  =  003H; 

RETURN; 
ENC; 

/* 

CHECK  FOR  ZERO  IN  OPERAND  2 

IF  Y  =  0  THEN 

CALL  ERFGR(3); 

J  =  SCFTkARE  DIVIDE,  1-4  =  HARDWARE  CIVIDE 


CC  CASE  PCSCPTION; 
CA: 


CASE  0  -  SCFTWiRE  DIVIDE 


DC; 
/* 

BEGIN  DIVISION  BY  SUBTRACTING  BOTH  OPERANDS  RESP, 

THE  DIFFERENCE  AND  SHIFTING/ADDING  BITS  TO  THE  RE- 

SLLTING  MANTISSA  FCR  EACH  POSSIBLE  SUBTRACTION  WITH 

PCSITIVE  RESULT,  AND  SHIFTING  ONLY  AND  ADDING  ONE 
PLACE  TO  OPERAND  1  IN  CASE  SUBTRACTION  YIELDED  A 
NEGATIVE  RESULT 
*/ 

CFI  =  SHR(-CFitl)  ; 
CF2  =  SFR(0P2, 1) ; 
11   =  0; 
ZE  =  o; 
I  =  l; 

CIFF  =  CPL  -  QP2; 
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IF  NOT  CARRY  THEN  DO; 
IF  CIFF  =  0  THEN  DO; 

RisULT  FOR  NUMBER  CIVIDED  BY  ITSELF 
*/ 

11  -   soooh; 
gc  to  setx; 

END; 
GO  1C    NOCARRY; 
END; 

CF1  =  SFL(CF1,1) ; 
ZE  =  -l; 

NEXTSTEP: 

DIFF  =  OP1  -  OP2; 

IF  CARRY  THEN  DO; 

CP1  =  SHL(OPl,l); 

GO  TO  SHIFT; 

END; 

/* 

NC  CARRY:  SET  OPERAND  1  TO  SHIFTEC  CIFFERENCE, 

ACD  ONE  TO  RESULTING  MANTISSA 

*/ 

NCCARRY: 

CF1    =    SFL(DIFF,1  ); 

11  =   11   +  l; 

/* 

SHIFT  MANTISSA  ONE  PLACE  TO  THE  LEFT 
*/ 

SHIFT: 

11    =  SHL(ZZtl) ; 

I  =  I  +  l; 

/* 

REPEAT  LNTIL  NORMALIZED 

*/ 

IF  I  <  16  THEN 

GC  TC  NEXTSTEP; 

/* 

SET  EXPCNENT 
*/ 

SETX: 

ZE    =     (X(2)    AND    07FH)     -    (Y(2)    AND    07FH)    +    ZE    +    65; 

/* 

CFECK  FOR  OVERFLOW  AND  UNDERFLOW 

*/ 

IF  (ZE  AND  C7FH)  <  0  THEN 

CALL  ERROR(O)  ; 
IF  (ZE  AND  080H)  <>  0  THEN 

CALL  ERRCR(l) ; 

SET  SIGN  BIT 

P(2)  =  ZE  CR  ((X(2)  ANC  080H)  XCR  (Y(2)  AND  080H)); 

ASSIGN  FESULTING  MANTISSA  VALUES 

*/ 

P     =  FIGH(ZZ); 

p(  l)  =  low(ZZ) ; 
return; 

END;    /*  CASE  0  */ 
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CASE  1  -  HARDWARE  DIVIDE,  SLOT  0 

c  c  * 

OUTPUT (30H)    =    Y(l) ; 
CLTPUTOIH)    =    Y; 
CLTPUT03H)     =    0; 
C    =    INPUTOIH)  ; 
C(l)    =    INPUTO0H); 
END;  /*    CASE    L    */ 


/+ 

CASE  2  - 


HARDWARE  DIVIDE,  SLOT  1 


DC; 

CUTPUT{34H)  =  Yd  ); 
CLTPUT(35H)  =  Y; 
0UTPUT( 37H)  =  0; 
C  =  INPUT05H); 
C(l)  =  INPUT(34H>; 
ENC;    /*  CASE  2  */ 


CASE  3  - 


HARDWARE  DIVIDE,  SLOT  2 


DC  " 

OUTPUT (38H)  =  Y(ll; 
0LTPUT( 29H)  =  Y; 
CLTPUT(3SH)  =  0; 
C  =  INPUT(39H); 
C(l)  =  INPUT(38H) ; 
END;    /*  CASE  3  */ 


CASE 
*/ 

D 
0 
C 

c 
c 

r 

END; 

/* 
NULT 

RESU 


4  -  HARCWARE  DIVIDE,  SLOT  3 


C; 

LTPUTC3CH)    =    Y( 1 ); 

LTPUT(3DH)     =    Y; 
UTPUT(3FH)    =    3; 

=    INPLT(3CH) ; 
(1)    =     INPUT(3CH)  ; 
NO;  /*    CASF    4    */ 

/*    CASE    I     STATEMENT    */ 


IPLY    RECIPROCAL    CF    Y    BY    X    TO    GET 
LT    FOR    HARDWARE    CASES 


IF     (V  (2)     AND    7FHJ     <    2    THEN 


C\/ERFLCW    PROTECTION 
0 

c 

r 
I 


C; 

(2)     =    (Y(2)    AND    80H)     OR    (7FH    -     (Y(2)    AND    7FH)); 

ALL    MULT(XA, .C ,PA)  ; 

F     ((P(2)     AND    7FH)    +    2)    >    7FH    THEN 


VERFLOW 

/ 

CALL    ERRCR(l) ; 
LSE 

P(2)    =    P(2)    +    2; 
NC; 
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ELSE 

/* 

NC  OVERFLOW  PROTECTION  NEEDED 
*/ 

CO* 

C(Z)    =  (Y(2)  AND  80H)  OR  (81H  -  <Y(2)  AND  7FH)); 

C&LL  MULT(XA, ,C,PA)  ; 

ENC; 

RETURN  ; 
END  CIV; 

SGRT:  PROCEDURE  (XATPA); 

DECLARE  XA  ADCRESS,  X  BASED  XA  BYTE, 

PA  ADDRESS,  P  BASED  PA  BYTE, 

(CC1  ,C2,C3,B,B1,B2,R)  BYTE; 

/* 

ASSLME  THAT  XA  IS  A  POSITIVE  REAL  NUMBER  AND  THE 
INITIAL  APPROXIMATION  FOR  THE  ROOT  IS  NANT*EXP/2 
*/ 

B      =    x ; 

31  =   X(l); 

32  =    X(2)     -    64; 

IF     (E2    ANC    080H)    =    0    THEN 

E2    =    SHR(82,1)     +    64; 
ELSE 

CO; 

E2    =    -B2; 

B2    =    SHR(32 ,1) ; 

B2    =    64    -    B2; 

Er>D; 

CC    P=l    TO    4; 

CALL    DIV(XA,.B,.C); 
C£LL    ADD(.C,.3, .B)  ; 

e  (2)  =  3(2)-i ; 

END; 

f       =   B; 
F(l)=   8(1); 

F(2)=    B(2)  ; 

RETURN; 
ENC    5QRT; 

DECLARE     (ID, TEMP, TEMPI, TEMP2, ENTRY, ENTRY1 ,  ENTRY2 )    BYTE; 

COMPARE:    PROCEDURE    (XA,YA)    BYTE; 
CECL4RE    XA    ACCRESS,     X    BASED    XA    BYTE, 

YA    ADCRESS,     Y    BASED    YA    BYTE, 

(CHECK1,     CHECK2)    ADDRESS, 

(XP,YP,XE,YE)  BYTE; 

MrvE  EXPONENTS  INTO  WORKING  AREA 
*/ 

XE  =  X  (2  )  AND  80H; 
YE=Y(2)  ANC  83H; 
IF  (>E  =  YE)  THEN  DO; 

/* 

EXPCNENTS  EQUAL 

XF=X(2)  AND  7FH; 
YF=Y(2)  ANC  7FH; 
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/* 

MCVE    MANTISSAS    INTO    WORKING    AREA 
*/ 

CFECK1=SHL(CCUBLE(X),8)    OR    X(l); 
CFECK2=SHL<D0UBLE(Y) ,8)    OR    Y(l); 
IF    (XE    =    080H)    THEN    DO; 
IF     (XP    <    YP)     THEN 

RETURN    2; 
IF     (XP    >    YP)     THEN 

RETURN    0; 
IF    CHECK2    <    CHECK1    THEN 

RETURN    0; 
IF    CHECK2    >    CHECK1    THEN 

RETURN    2; 
RETURN    1; 
END; 
IF    (XP    <    YP)    THEN 

RETURN    0; 
IF    (XP    >    YP)    THEN 

RETURN    2; 
IF    CHECK2    <    CHECK1    THEN 

RETURN    2; 
IF    CHECK2    >    CHECK1    THEN 

RETURN    0; 
RETURN    1; 
END; 
IF     (XE    =    0)    THEN 

RETURN    2; 
RETURN    0; 
ENC    CCMFARE; 

D5CLAPE     (TvTl,T2f ZtZlffZ2)    BYTE; 

FUNCTION:    PRGC EDUPE ( I ,X A  ) ; 

DECLARE     I    BYTE,     XA    ADDRESS,     X    BASED    XA    EYTE; 

/* 

I=C   ATAN  =  ATANGENT 

1=1   IS  NOT  USED  PRESENTLY 

1=2   CCSSIN  =  COSINE  AND  SINE 

*/ 

/* 

CCS:     FPCCEDURE    ( XA ) ; 

*/ 
DECLARE    TEMPCCS     (195)     BYTE     INITIAL! 

0CCF,CCOH,OCOH,0C9H,OOEH,03BH,OC9H,OOEH,O3CH,O96H,0CAH,O3CI-, 
0C9H,GCEI-,030I-, 

JFBF,C5 lHfC3DHf096H,0CAH,O3EH,OAFH,0ECH,03EHtOC9H,00EH,O3Eh, 
0E2h,02FH,C3EH, 

OFBH,0  5  1F,C36H,08AH,039h,03FH,096H,OCAH,C3FH, JA3H  ,3  5BH , 03 FH  , 
CAFh  ,CECF,03FH, 

OBChtC7DHf03FHfOCSH,OOEH,03FH,OD5Hf09EH,03FH,OE2H,02FH,03FH, 
0EEF,GCCI-,03FF, 

0FBh,C5  1H,C3FH,083H,OF1H,040H,08AH,039H,040H,0  90H,082H,040I-, 
096F,OCAH,040I-, 

0  9DI-,312H,040H,  JA3H  ,  J5BH, 040H , 0A9H, 0 A3F , 040H, 0 AFH  ,OECH, 040F , 
086H,034H,040F, 

0  SC  I-,  C  7  CH,  040  H,  OC  2H,  OC  5  H,  040H,0C9H,00EH,C40H,JCFH,  3  56H,  04  OH, 
0D5F,CSEH  ,C40H, 

ODBF,CE7H,040H,OE2H,02FH,040H,OE8H,078H,040H,OEEH  ,0C0H,040H, 
0F5F,GC9F,043F, 

0FBF,C5  1H,C40H, C8CH , OCCH , 04 1H ,083H ,0F 1H  ,041H, 08 7H  ,015H, 041 h , 
08Ah,C39h,041H, 

38Dh,C5DH,Q41H,09  0H,382H,041H,093H,OA6H,041H,0  96H,OCAH,041F, 
C99F,0EEF,041H, 
09DF,012H,041H,OAOH,037H,041H,OA3H,0  5BH,C41H, 3A6H  ,  37FH, 041H , 

OA9htCA3Hf04iHf 

OACh,OC8H,041H,OAFH,OECH,041H,033H,01CH,041H,OB6H  ,C34H,041H, 
0B9F,C58F,041F, 

0BCH,C7DH,041H,0BFH,0A1H,C41H,0C2H,0C5H,041H,0C5H,0E9H,041F, 
0C9h,0CFI-,041H)  ; 
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DECLARE  VALCOS  (195)  BYTE  INITIAL* 


CECLARE  CIF«=CCS  (195)  3YTE  INITIAL  ( 
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(E,V,C,V1  ,D1)     (3) 

(LOOK  I,     MAXI)     BYTE, 

ICGK     (3)     eYTE     INITIAL     (249,0,195), 

MAX    (3)     3YTE    INITIAL     (249,0,195), 

ENTA    ADDRESS,     ENT    BASED    ENTA    BYTE, 

VALA    ADDRESS,     VAL    BASED    VALA    BYTE, 

DIFFA    ADDRESS,     CIFF    BASED    DI^FA    BYTE, 

V^LIA    ADCRESS,     VAL1    BASED    VAL1A    BYTE, 

DIFF1A    ADCRESS,     DIFF1    BASED    DIFF1A    BYTE; 

/* 

INPLT  CCNSISTS  OF  A  BASED  VARIABLE,  CUTPUT  WILL  eE 

IN  GLCBAL  VARIABLES  T,  Tl,  T2,   AND  Z,  Zl,  Z2 
*/ 

E(C)  =  .TEMPATAN; 
V(J)  =  .VALATAN; 

C(0)  =  .diffatan; 

E(2)  =  .TEyPCQS; 
V(2)  =  .valccs; 
C(2)  =  .DIFFCGS; 

ENTA  =  E( I ); 

VALA  =  V(  I  ); 

CIFFA  =  C( I) ; 

VALIA  =  VI (I ) ; 

CIFF1A  =  CKI); 

LCCKI  =  LGCK( I  ); 

PAXI  =  MAX(I ) ; 

ENTRY  =  X; 

ENTRY1  =  X(l) ; 

ENTRY2  =  X(2)  *, 

IF  (LCCKI  =  MAXI)  THEN 

LCCKI  =  0* 
IC  =  CCMPARE  I  .ENTRY,ENTA+L00KI) ; 
IF  (IC  =  1  )  THEN 

GC  TO  XITl; 
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/* 

RE£C    UPWARDS    IN    THE    TABLE 
*  / 

IF     (IC    >    1 )    THEN    DO; 
LPl:       IF     (LOCKI    =    MAXI)     THEN 

GO    TO    XITl; 
LCCKI=LC0KI+3; 

ID=CCMPARE(  .ENTRY,ENTA  +  LOOKI) ; 
IF     (10    =    1)    THEN 

GC    TO   XITl; 
IF    110    >    I)    THEN 

GC    TO    LPl; 
LCCKI=LCCKI-3; 
GO    TO    XIT2; 
Else; 

/* 

READ    DOWNWARDS     IN    THE    TABLE 

LP2:    IF    (LOCKI    =    0)    THEN 

GC    TO    XITl; 
LCCKI=LQCKI-3; 

IC=CCMPARE( .ENTRY,ENTA+LCOKI  ); 
IF     (ID    =     1)     THEN 

GC    TO    XITl; 
IF     (ID    <     L)     THEN 

GO    TO    LP2; 
GC    TC    XIT2; 

XITl:    T       =    VAL(LCCKI ) ; 

Tl  =  VAL(LGCKI+1 ) ; 
T2  =  VAL(L0CKI+2)  ; 
IF    (I    <>    1)    THEN 

GC    TC    RET; 
Z       =    VALK  LCOKI  )  ; 
Zl    =    VALKLCOKI  +  1  )  ; 
Z2    =    VALKLCGKI+2)  ; 
GC    TO    RET; 

XIT2:    TEMP       =    ENT(LOOKI ); 

TEMPI    =    ENT(L00KI+1) ; 
TEMP2    =    ENT  (L00KI+2) ; 

/* 

CHANGE  THE  SIGN  OF  TEMP 
»/ 

TEMP2  =  TEMP2  XOR  80H; 

/* 

TEMP  =  ENTRY  -  ENT(LOOK) 

*/ 

CALL  ADC(  .TEMP, .ENTRY, .TEMP ); 

/* 

(ENTRY  -  ENT(LOOK) )*DIFF(LOOK) 

*/ 

C/LL  MULT(  .TEMP,DIFFA  +  LOOKI  ,.T) ; 

CALL    ADC(.T,VALA+LCCKI, .T) ; 

/* 

VAL(LOOK)     +    ENTRY    -    ENT(LOOK)    *    CIFF(LOOK) 

*/ 

IF  (I  <>  1)  THEN 
GO  TC  RET; 

CALL  MULT( . TEMP, D IFF1 A+LOOK I , .Z) ; 

CALL  ADD(.Z,VAL1A+L00KI,.Z) ; 
RET:   LCCK(I)  =  LCCKI; 

RETURN; 
END  FUNCTION; 
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CCSSIN: 
CECLARE 


PPOCECURE(XA,AC,AS)  ; 
XA  ADDRESS,  X  BASED  XA  BYTE, 
AC  ADDRESS,  S  BASED  AC  BYTE, 
AS  ACDRESS,  Y  BASED  AS  BYTE, 
(I,TH  ,Thl,TH2 ,THN,THN1,THN2) 


DECLARE 


(MPI2,.MPI21,MPI22) 
CUT  LABEL; 


EYTE, 


BYTE  INITIAL  ( 0C9H , OFH  ,0C1H ) 


/* 

THIS 

FOP 

APE 

CCSI 

*/ 
TF 
Th 
TF 
CC 


RCUTINE  COMPUTES  SQTH  TFE  COSINE  AND  THE  SINE 
THE  GIVEN  ANGLE  XA  IN  RADIANS.   THE  OUTPUT  VALUES 
STCRED  IN  THE  GLOBAL  VARIABLES  Z,  Zl,  AND  Z2  FOR 
NE,  AND  T,  ti,  AND  T2  FCR  SINE 

=  X  * 

1  =  X  ( 1 )  ; 

2  =  X(2) ; 

1=1  TC  4; 
TFN!   =  th; 
TFN1  =  THl; 
TFN2  =  TH2; 

/* 

TFETA  =  THETA  -  (PI/2) 

*/ 

CALL  ACC  (  .TH,  .,MPI2,.TH)  J 

/* 

T|-N  =  THETA  BAR  AND  TH  =  THETA  BAR  -  (PI/2) 

*/ 

IF  (((ZE  AND  80H)  <>  0)  OR  ((ZZ 

(ZE 
GO  TO  OUT; 
END; 
RETURN; 

OUT  : 

TF2=ZE  AND  7FH; 

CALL  FUNCTION  (2,  .THN)  ; 

TFN   =  T; 

THN1  =  Tl; 

TFN 2  =  T2; 

TFN  =  COS  (TH) 

*/ 

CALL  FUNCTION  (2,.TH); 

TF   =  T; 

TF1  =  Tl; 

TF2  =  T2; 


OOOOH)  ANC 
OOH) ) )  THEN 


/* 

TF  = 
*/ 

/* 

ANGLE 
*/ 


SIN  (TH)  =  COS  (PI/2  -  TH) 


IN  CUADRANT  1  OR  3 


IF  ( (I  =  1)  OR 


Z 

Z  1 

Z2 

T 

Tl 

T2 

IF 


(S 

(S(l) 

(S(2) 

(V 
(1) 
(2) 
3) 


=  (Y 

=  (Y 
(I  = 

Z2  = 

T2  = 

RETURN, 

END; 
RETURN; 
END; 


(S(2) 
(Y(2) 


(1=3)) 

=  THN); 

=  THN1)  ; 

=  THN2)  *, 

=  TH )  ; 

=  THl ); 

=  TH2  ) ; 
THEN  DO; 
=  Z2 
=  T2 


THEN  DO 


XOR 

XOR 


080F) ; 
080H) ; 
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/* 

ANGLE 

*/ 

2 

Zl 

11 

T 

Tl 

T2 

IF 


IN  QUADRANT  2  GR  4 


II  = 

T2  = 

Z2  = 

END; 

RETURN; 

EN'C  CCS5IN; 


( S     :  =  TH  )  ; 

(S(l)  :=  TH1J  ; 

(S(2)  :=  TH2  XOP 

(Y     :=  THN); 

(Yd)  :=  THN1  )  ; 

(Y(2)  :=  THN2); 
4)  THEN  DO; 

(S(2)  :=  T2  XCR 

(Y(2)  :=  Z2  XGR 


080H) 


080H)  ; 
080H) ; 


AT4N:  FPCCEDURE  (XA, AT) ; 
DECLARE  XA  ADDRESS,  X  BASED  XA  BYTE, 
AT  ADDRESS,  TV  BASED  AT  BYTE; 

CALL  FLNCTICN(C, .X) ; 
TV(0  )  =  T; 
TV(1)  =  Tl ; 
TW2)  =  T2; 

RETURN; 
ENC  ATAN; 

REAL:  FPCCEDURE  (AD, PL); 

CECLARE  AC  ADDRESS, XI  BASED  AD  BYTE,  Z  (40)  BYTE, PL  BYTE; 

EICEC:  PROCEDURE  (AY,FL); 

CECLARE  AY  ADDRESS,  Y  BASED  AY  BYTE, 

( FL,FLAG,I ,L,K,SHIFT,R,LASTI,J )  BYTE, 

X  (16)  BYTE,  (XX, YY)  ADDRESS; 

EICEC  CONVERTS  THE  BINARY  INTERNAL  REAL  NUMBER  TO  A 
CECIMAL  NUMBER,  WHICH  CAN  BE  PRINTEC  BY  THE  MCNITOR 


FL 


IS  A  FLAG  ^HICH  INDICATES  THE  NUMBER  TO  BE 


CCNVERTED 


PL  =  0   REAL 

FL  =  1   ADDRESS  VARIABLE 

FL  =  2   BYTE  VARIABLE 


DC 


DC 


1  =  0  TO 
X(I)=0 
END; 


15; 


1=0  TC  3S; 
Z(I )=0; 

END; 

IF    Y=0    THEN 
RETURN; 

YY=SHL(COUBLE(Y) ,8)    OR    DOUBLE ( Y (  1 )) ; 
IF    (Y(2)    ANC    8JH)OJ    THEN    DO; 

FLAG=l; 

K=Y(2)     AND    07PH; 

END; 
ELSE    DC; 

FLAG=3J 

K=Y(2) ; 

END; 
L=K-£4; 
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IF  (K  >=  64)  THEN  DO; 

I=SHR(Lt3); 

R=L-SHL(I,3) ; 

R=8-R; 

1=1+8; 

END; 
ELSE  DO; 

L=-l; 

I=SHR(L,3); 

R=L-SHL(I,3)  ; 

1  =  7-1 ; 

END; 

IF  (I  >=  1)  THEN  CO; 

X( I )=HIGH(YY) ; 

X<I-1)  =  LCW(YY)  ; 

YY=SHL( DOUBLE (X(I-l)  ),8)  ; 

YY=SHR(YY,R) ; 

IF  (  I  >=  2)  THEN 

X( 1-2)  =  LOMYY)  ; 

YY  =  SHL(OCUBLE(X(I  )),8)  OR  DOUBLE ( X( I -  1 ))  ; 

YY=SHR(YY,R) ; 

X( I)=HIGH(YY) ; 

X( I-1)  =  LCW(YY)  ; 

END; 
ELSE 

X( I)=SHR(X( I) , R) ; 

IF  (I  >=  8)  THEN  CO; 
LASTI=I ; 
R=0; 
K=20  ; 
RECYCLE:  XX=SFL ( DCUBLE ( P ) ,8 )  OR  X(I); 
YY=XX/10  ; 
X( I )=LOW(YY)  ; 
R  =  XX  MQO  10; 
IF  (  I  =  8)  THEN  DO; 
Z(K)=R+'0» ; 
K  — K+ 1  * 
IF  (X(8)  =  0)  THEN 

GO  TO  FR4CT; 
IF  (X(LASTI )  =  0)  THEN 

LASTI  =  LASTI  -  1; 
R  =  3; 

I=LASTI ; 
GC    TO    RECYCLE; 
END; 

I  =    I  -   l; 

GO    TC    RECYCLE; 
END; 


CECLARE    LEASTI    BYTE; 

FRACT:     IF    FL=C    THEN    DO; 
LEASTI=I-2; 
IF    LEASTI    >=    8 

RETURN; 
DO    1^0    TC    19; 

L=o; 

CO    K=LEASTI 


THEN 


ENC 


TO  7; 
YV=DOUBLE(X(K) ) *10+DOUBLE ( L ) ; 
X(K)  =  LOV*(YY)  ; 
L=HIGH(YY) ; 
END; 
Z(19-I)=L+'0' ; 

END; 

END; 
IF  FLAG=1  THEN 

Z(39)=CFFH; 
RETURN; 
EICEC; 


79 


PRINTNUM:  PROCEDURE; 
CECLARE  (I2K)  BYTE; 
CECL4RE  (DIGIT,  ENTRY) 


LABEL ; 


/* 

PRINTS  A  REAL  NUMBER  IN  THE  FORM 
kITH.  LEADING  ZEROES  SUPPRESSED 
*/ 


(-)XXXXX.XXXXXXX 


DIGIT 


ENTRY 


DC  1=1  TC  5; 

IF  (  I  =  5)  AND  (Z(20)  =  0) 
IF  (Z(39)  =  OFFF)  THEN 

CALL  PRINTCHARC-' ) ; 
ELSE 

CALL  PRINTCHARC  '  )  ; 

GC  TO  entry; 
END; 

IF  Z(25-I)  <>  0  THEN  DO; 
IF  (Z(39)  =  OcFF)  THEN 

CALL  PRINTCHAR( 
ELSE 

CALL  PRINTCHAR( 
GO  TO  DIGIT; 
END; 

CALL  PRINTCHARC  ■  )  ; 
END; 
GC  TO  ENTRY; 


DC  K=I  TC  5; 

CALL  PRINTCHAR(Z(25-K)  )  ; 

END; 


-•  ); 

•  ) ; 


CALL  PRINTCHARC  .  ■  )  ; 
DC  K  =  1  TG  7; 

CALL  PRINTCHAR (Z(20-K)  )  ; 
ENC; 

return; 
end  printnum; 

CALL  eiDEC(.XI  ,FL) ; 
CALL  PRINTNUM; 
RETURN; 
END  REAL; 


THEN  DO; 
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/* 

INITIALIZATION    OF    OMEGA    STATION    CIRECTION    COSINE    VALUES 
WHICH    REPRESENTS    A    UNIT    VECTOR    FROM    EARTH'S    CENTER    TO 
THc    STATION    IN    GEOCENTRIC    COORDINATES 
*/ 


DECLARE 
SAl  (3) 
SA2  (3) 
SA3  (3) 

BYTE 
EYTE 
EYTE 

SBl 
SB2 

SB3 

(3) 
(3) 
(3) 

BYTE 
BYTE 
EYTE 

SCI 
SC2 
SC3 

(3) 
(3) 
(3) 

BYTE 

BYTE 
BYTE 

SCI 

SC2 
SD3 

(3) 
(3) 
(3) 

BYTE 
BYTE 
BYTE 

SEl 
SE2 
SE3 

(3) 
(3) 
(3) 

BYTE 
EYTE 
BYTE 

SF1 

SF2 
SF3 

(3) 
(3) 
(3) 

BYTE 
BYTE 
EYTE 

SGI 

SG2 
SG3 

(3) 

(3) 
(3) 

BYTE 
BYTE 
BYTE 

/*  STATION 
INITIAL  (OEAH, 
INITIAL  (OC8H, 
INITIAL     (OEBH, 


/*    STATION    B    */ 
INITIAL     (OFBH,    072H,     040H), 
INITIAL     (OFBH,     02EHt     040H), 
INITIAL     (3A9H,    ODDH,     OBEH), 


/*     STATION    C    */ 
INITIAL     (0B9H,     OC5H,     03FH), 
INITIAL     (OCCh,     OEBH,    OCOH), 
INITIAL     (084H,    007H,     OBFH), 


/*    STATION    D    */ 
INITIAL     (OB8H,     OBOH,     040H), 
INITIAL     (OCDH,     099H,     OBDH), 
INITIAL     (OAFH,    066H,     OCOH), 


/*     STATION    E    */ 
INITIAL     (086H,     032H,     OBFH), 
INITIAL     (OS8H,     03AH,    040H), 
INITIAL     (0C4H,     CABH,     040H), 


/*    STATION    F    */ 
INITIAL     (OAEH,     023H,     OCOH), 
INITIAL     (09DH,     078H,     03FH), 
INITIAL     (OAAH,     054H,     OCOH), 


/*    STATION    G    */ 
INITIAL     (OBCH,     OECH,    03EH), 
INITIAL     (OEFH,     009H,     03FH), 
INITIAL     (OCCr,     067H,     OCOH), 


A  */ 

05FH, 

040H) , 

/* 

C. 91551829 

*/ 

08FH, 

03FH) , 

/* 

0.39172334 

*/ 

077H, 

03DH), 

/* 

0. C9153733 

*/ 

/*  0.98221041  */ 
/*  C.S8117517  */ 
/*   -0.16588382    */ 


/*  0.36283281  */ 
/*  -0.66296869  */ 
/*    -0.35162108    */ 


/*  C. 72144222  */ 
/*  -0.  1CQ39077  */ 
/*  -0.68515898  */ 


/*  -C. 35535299  */ 
/*  0.53214875  */ 
/*   0.76323587  */ 


/*  -0.68C22941  */ 
/*  0.30756230  */ 
/*  -C.665352C7  */ 


/*  0.18449565  */ 
/*  C. 46687116  */ 
/*    -0.66436570    */ 


/*    STATION    H    */ 

SHI     (3)     BYTE     INITIAL     (090H,     0C2H,    040H),  /* 

SH2     (3)     BYTE     INITIAL     (086H,     02BH,     OCOH),  /* 

SH3     (3)     EYTE     INITIAL     (JA3H,     007H,     040H);  /* 


0.56547261    */ 

•C.524C9936    */ 

0.63683639    */ 


VELOCITY  ANC  NAVIGATION  PROCESSING  DEFINITIONS 


CECLARE 

/*  NAVIGATION  CYCLE  -  1.0  SEC  */ 
DTNAV  (3)  BYTE  INITIAL  (C80H,  OOOH,  041H), 


DELT2 
DELT3 


EEC 


/*  ANGULAR  ROTATIONS  ABOUT  THE  SYSTEM  AXIS  */ 


(3)  BYT= 


i- » 


(3)  BYTE, 

/*  EARTHS  ELLIPTICITY  CONSTANT  -  0.0033529  */ 
(3)  BYTE  INITIAL  (OCBH,  03CI-,  038H, 


/*  OMEGA  AIRCRAFT  LATITUDE  AND  LONGITUDE 
0LAT£C(-3)  BYTE, 
CLCNAC(3)  BYTE, 


*/ 
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/* 

INITIAL  LCCATICN  MONTEREY,  CALIFORNIA 
LATITUDE  36DEG  35  MIN  N  -  0.638499618  RADIANS 
LCNGITUCE  121DEG  51  MIN  W  -  2.126683694  RADIANS 
NCTE:  INSERT  N  LAT.  POSITIVE 
INSERT  S  LAT.  NEGATIVE 
INSERT  E  LONG.  POSITIVE 
INSERT  W  LONG.  360DEG  -  INITIAL  LONG. 
*/ 
CLATJN(3)  eYTE  INITIAL  UA3H,  074H,  D4QI-), 

/* 

INSERT  36CDEG  -  121DEG  51MIN  W 
INSERT  238DEG  09  MIN  -  4.156501614  RADIANS 
*/ 
CLCMNI3)  BYTE  INITIAL  (085H,  002H,  043H, 

/*  EARTHS  MEAN  EQUATORIAL  RADIUS  -  20925741.47  FT  */ 
EMER   (3)  BYTE  INITIAL  (C9FHT  0A6H,  059H), 

/*  WIND  DIRECTICN  */ 
WD     (3)  BYTE, 

/*  AIRCRAFT  HEADING  */ 
AOCG  (3)  BYTE, 

/*  SYSTEM  HEADING  ANGLE  *7 
SHDGA  (3)  BYTE, 

/*  OLD  MODE,  NEW  MODE,  NAVIGATICN  MODE  */ 
lOLCfi  N'EWPf  NAVMCCE)  BYTE, 

/*  DVC3  =  (VC3  *  DTNAV)  /  EMER  */ 
CVC3  (3)  BYTE, 

/*  DVC2  =  (VC2  *  DTNAV)  /EMER  */ 
CVC2  (3)  EYTE, 

/*  ELEMENTS  X5  AND  X6  OF  STATE  VECTOR  */ 
SIGVC2  (3)  BYTE  INITIAL  (OOOH,  OOOH,  04CH), 
SIGVC3  (3)  BYTE  INITIAL  (OOOH,  OOOH,  040H), 

/*  CONVERSION  FACTOR  RADIANS  TO  DEGREES  */ 

RADTCDEG  (3)  BYTE  INITIAL  (08EH,  OFAH,  03BH), 

/*  TEMP.  STORAGE  AFTER  CONVERSION  RAD  TO  CEG  */ 

/*  AIRDATA  VELOCITY  COMPONENT  NORTH*/ 
/*  AIRDATA  VELOCITY  COMPONENT  EAST  */ 
/*  DOPPLER  VELOCITY  COMPONENT  NORTH*/ 
/*  DOPPLER  VELOCITY  COMPONENT  EAST  */ 
/*INERTIAL  VELOCITY  CGMFCNENT  NORTH*/ 
/*INERTIAL  VELOCITY  COMPONENT  EAST  */ 
/*  CORRECTED  VELOCITY  ALONG  R2  AXIS*/ 
/*  CORRECTED  VELOCITY  ALONG  R3  AXIS*/ 
/*  DOPPLER  VELOCITY  ALONG  HEADING  */ 
/*  DOPPLER  VELOCITY  ACROSS  HEADING  */ 
/*  TRUE  AIR  SPEEC  VELOCITY  */ 

/*  WIND  VELOCITY  */ 

OF  3  BY  3  POSITION  MATRIX  */ 


RESLLT 

(3)  BYT 

VAN 

(3) 

BYTE, 

VAE 

(3) 

BYTE, 

VDN 

(3) 

BYTE, 

VDE 

(3) 

BYTE, 

VIN 

(  3) 

BYTE, 

VIE 

(3) 

BYTE, 

VC2 

(3) 

BYTE, 

VC3 

(3) 

BYTE, 

VCA 

(3) 

BYTE, 

VCC 

(3) 

3/TE, 

VTAS 

(3) 

3VTE, 

VW 

(2) 

BYTE, 

/  = 

>  ITEMS 

Rll 

(3) 

BYTE, 

R12 

12) 

BYTE, 

R13 

(3) 

BYTE, 

R21 

(3) 

BYTE, 

R22 

(3) 

BYTE, 

R23 

(3) 

BYTE, 

R31 

(2) 

BYTE, 

R32 

(3) 

BYTE, 

R33 

(2) 

BYTE; 
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INITIAL  IZE$R:  PROCEDURE; 
/* 

INITIALIZATION  OF  POSITION  MATRIX  R 
'  / 

/* 

Rll  =  SIN(LAT),  R31  =  COS(LAT) 

CALL  COSSIN  (.CLATIN,  .R31,  .Rll); 

/* 

R22  =  SIN(LONG),  R23  =  CCS(LONG) 

CALL  CCSSIN  (.GLGNIN,  .R23,  .R22); 

/* 

R12  =  COS(LAT)  *  CCS(LGNG) 

*/ 

CALL  MULT  (.R31,  .R23,  .R12); 

/* 

R13  =  COS(LAT)  *  SIN(LONG) 

*/ 

CALL  ^ULT  (.R31,  .R22,  .R13) ; 

/* 

R21  INITIALIZE  TO  ZERO 

*/ 

R21  (0)  =  COOH; 

R21  (1)  =  OJJh; 

R21  (2)  =  COOH; 

/* 

CHANGE  THE  SIGN  OF  Rll 

V 

Pll  (2)  =  Rll  (2)  XOR  080H; 

/* 

R23  =  -SIN(LAT)  *  SIN(LONG) 

*/ 

CALL  MULT  (.Rll,  .R22,  .R33); 

/* 

P22  =  -SIN(LAT)  *  COS(LONG) 

4  / 

CALL  MULT  (.Rll,  .R2i,  .R32); 

/* 

CHANGE  THE  SIGN  OF  Rll  AND  R22 
*/ 

Rll  (2)  =  P.1K2)  XOR  080H; 
P22  (2)  =  R22(2)  XOR  080H; 
RETURN; 
END  INITIALIZESR; 

NETPCS:  FROCEDURE; 

/* 

UPCATE  THE  POSITION  MATRIX  R  AND  CALCULATE  NEW 
LATITUCE,  LONGITUDE,  ANC  SYSTEM  HEADING  ANGLE 
*/ 

DECLARE  (A,  Al,  A2,  A3,  B,  Bl,  B2 ,  B3 ,  CI,  C2,  C3)  (3)  BYTE, 
(SUM1,  SUP2,  SUN3,  D2SQR,  D3SCR)  (3)  BYTE; 

CALL  NULT  (.DELT2,  .P31,  .A); 
CALL  MULT  (.DELT3,  .R21,  .B); 
CALL  SUB  (  .6,  .A,  .CD  ; 
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C/SLL    MILT     (.DELT2,     .R32,  .A) 

CALL    MjLT     (.DELT3,     .R22,  .B) 
CALL    SUB    (  .B,     .A,     .C2) ; 

CALL    MULT     (.DELT2,     .  P33  ,  .A) 

CALL    MULT     (.DELT3,     .P23,  .B) 
CALL    SUB    ( .B,     .A»     .C3) ; 


CALL  ADD 
CALL  ACD 
CALL    ADD 


(  .CI, 
(  .C2, 
(  .C3, 


.Rll, 

.R12, 
.R13, 


.SUM1) ; 
.SUM2); 
.SUM3); 


/* 

SUBTRACTING  ONE  FROM  THE  EXPONENT  VALUE  WILL 

CAUSE  THE  MANTISSA  TC  APPEAR  TO  BE  DIVIDED  BY 

*/ 

CI  (2)  =  CI  (2)  -  OOIH; 

C2  (2)  =  C2  (2 )  -  JOIH; 

CS  (2)  =  C3  (2)  -  OOIH; 


CALL  ADD 
CALL  ACD 
CALL  ACC 

CALL  MULT 
CALL  HULT 
CALL  ADC 

E  (2)  =  B 
CALL  MULT 
CALL  MULT 
CALL  NULT 

CALL  SUB 
CALL  SUB 
CALL  SUB 


(  .CI, 
(  .C2, 
(  .C3, 


( 


.Rll,  .Al) 
.R12,  .A2) 
.R13,  .A3) 


DELT2, 
(.DELT3, 
( .D2SCR, 


.CELT2, 
.CELT3, 
D3SQR, 


.D2SQR) 
.D3SQR) 
B); 


(2  )  -  OOIH; 
( .3,  .Rll,  .Bl ) ; 
(.B,  .R12,  .82); 
(.8,  .R13,  .33); 


(  .SUM1, 
(  .SUM2, 
(  .SUM3, 


CALL  MULT  (.Al, 
CALL  PULT  (.Al, 
CALL  SUB  ( .R21 , 
CALL  ADD  (  .R31, 

CALL  NULT  (.A2, 
CALL  MULT  (.A2, 
CALL  SUB  (  .R22, 
CALL  ADD  (  .R32  , 

CALL  NLLT  (.A3, 
CALL  MULT  (.A3, 
CALL  SUB  (  .R23, 
CALL  ACD  (.R33, 


.  B 1 ,  .Rll); 
.82,  .R12); 
.83,  .R13); 

.DELT3,  .A); 
.DELT2,  .B); 
.A,  .R21); 
.8,  .R31); 

.DELT3,  .A); 
.DELT2,  .B); 
.A  ,  .R22 )  ; 
.8,  .R32); 

.DELT3,  .A); 
.DELT2,  .B); 
.A,  .R23); 
.B,  .R33); 


CALL  CIV  (  .R21,  .R31,  .A)  ; 
CALL  DIV  ( .R13,  .R12,  .B) ; 


CALL 
CALL 


ATAN 
ATAN 


(  .A, 
(  .B, 


.SHDGA) ; 
.OLONAC) ; 


CALL  CCSSIN  (.SHDGA,  .8,  .A) 


CALL  NULT  (.B, 
CALL  CIV  ( .A, 

call  atan  (.8, 

return; 

END  NEWFCS; 


.Rll,  .A) 

.R31,  .B); 

.OLATAC)  ; 


VELPPCC:  PROCEDURE; 

CCfPUTE  NORTH,  SOUTH,  EAST,  AND  WEST  VELOCITIES 
ANC  COMPUTE  VELOCITIES  ALONG  THE  SYSTEM  AXIS 
*/ 
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DECLARE  (A,  Al,  A2,  A3)  (3)  BYTE, 
(6,  El,  82,  B3)  (3)  BYTE, 
(C,  CI,  C2,  D,  Dl)  (3)  BYTE, 
(DELVC2,  DELVC3)  (3)  BYTE, 
(VELE,  VELN)  (3)  BYTE; 

/* 

E  =  CCS(AIRCRAFT  HEADING),  A  =  SINCAIRCRAFT  HEADING) 

*/ 

CALL  CCSSIN  (.AChDG,  .B,  .A); 

/* 

C  =  CCSIWIND  DIRECTION),  C  =  SIN<WIND  DIRECTION) 

*/ 

CALL  CCSSIN  (  .WO,  .0,  .C) ; 

/* 

Al  =  SIN(ACHDG)  *  VDC 

*/ 

CALL  NULT  (  .A,  .VDC,  -Al) ; 

/* 

ei  =  CCS(ACHDG)  *  VDA 

*/ 

CALL  MULT  (.B,  .VDA,  .81) 5 

/* 

A2  =  SIMACHOG)  *  VDA  ■ 

*/ 

CALL  ^ULT  ( .A,  .VDA,  .A2 ) ; 

/* 

E2    =    CCSUCHDG  )    *    VDC 

CALL  MULT  (,B,  .VDC,  .B2); 

/* 

VCN  =  COS(ACHDG)  *  VDA  -  SIN(ACHDG)  *  VDC 

*/ 

CALL    SUB    (  .Bit     .Al,     .VDN)  ; 

/* 

VCE    =    COS(ACHDG)    *    VCC    +    SIN(ACHDG)    *   VDA 

CALL  ACD  (.62,  .A2,  .VDE)  ; 

/* 

E2  =  CCS(ACHDG)  *  VTAS 

*/ 

CALL  MULT  (.B,  .VTAS,  .33) ; 

/* 

A£  =  SIN(ACHDG)  *  VTAS 

CALL  NULT  (.A,  .VTAS,  .A3) ; 

CI  =  CCS(WC)  *  VW 

*/ 

CALL  NULT  (.0,  .V4,  .Dl) ; 

/* 

CI  =  SIMWC)  *  VW 

CALL  MILT  (.C,  .VW,  .CI)  ; 

VAN  =  CGS(ACHDG)  *  VTAS  +  COS(WD)  *  VW 
CALL  ACD  (  .B3,  .Dl,  .VAN  )  ; 
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/* 

VAE  =  SIN(ACHDG)  *  VTAS  +  SIN(WD)  *  VW 

*/ 

CALL  ACD  (.A3,  .CI,  .VAE); 

/* 

3  =  CCS(ShCGA),  A  =  SIN(SHCGA) 

C4LL  CCSSIN  (.SHDGA,  .B,  .A); 

CC  CASE  NAVMODE; 

/*  CASE  0  -  INERTIAL  COMPONENTS  */ 
CG; 

=  VIN(O) 

=  VIN(l) 

=  VIN<2) 

=  VIE(O) 

=  VIE(l) 

=  VIE(2) 


VELN(O) 
VELN(l) 
VELN (2) 
VELE(O) 
VELE(l) 
VELE(2) 
END;- 


/*    CASE    L    -    DOPPLER    COMPONENTS    */ 
CO; 

=  VDN(C) 
=  VDN( 1) 
=  VDN(2) 
=  VDE(O) 
=  VDE(l) 
=    VDE(2) 


VELN(O) 
VELN(l) 
VELN(2) 
VELE(O) 
VELE(l) 
VELE(2) 
END; 


/*    CASE    2    -    AIR    DATA    COMPONENTS    */ 
CO; 

=  VAN(O) 
=  VAN( 1) 
=  VAN(2) 
=  VAE(O) 
=  VAE(l) 
=    VAE(2) 


VELN(O) 
VELN(l) 
VELN(2) 
VELEO) 
VELE<1) 
VELE(2) 
END; 
ENC; 


/* 

81    =    VELE    *    COS(ShQGA) 

*/ 

CALL    MLLT    (  .VELE  ,     .3,     .81) ; 

Al    =    VELN    *    SIN(ShDGA) 

*/ 

CALL    ^ULT    (  .VELN,     .A,     .Al) ; 


B2    =    VELN 
CALL    MULT 


*    COS (SHDGA) 
(.VELN,     .B,     .B2); 


A2    =    VELE    *    SIN(ShDGA) 

*/ 

CALL    MULT     (.VELE,     .A,     .A2); 

/* 

A3    =    VELE    *    COS(SHOGA)     +    VELN    *    SIN(SHDGA) 

*/ 

CALL    ACC    ( .81,     .Al,    .A3)  ; 

8^    =    VELN    *    COS(SHDGA)    -    VELE    *    SIN(SHDGA) 
CALL    SUB    (.52,     .A2,     .83); 
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CHECK  IF  UPGRACE  OR  COWNGRADE  OF  NAV.  MODE 


IF  OLDN  <  NEW 

cc " 

CLcV  =  NEW 

/* 

CELTA  VC2 
*/ 

c^ll  sue  ( 


M  THEN 

=  VC2  -  (VELE*COS(SHDGA)  +  VELN*S  IN( SHDGA ) ) 
.VC2,  .A3,  .DELVC2); 


VC3 


( 


=  VC3  -  (VELN*COS(SHDGA)  -  VE LE*S  IN ( SHDGA ) ) 
.VC3,  .83,  .DELVC3); 


CELTA 
*/ 

CALL  sue 
ENC; 
ELSE 

DC; 

IF  CLDN 

CO; 

/* 

SET  CELTA  VC2  *ND  CELTA  VC3  TC  ZERO 

*/ 

DELVC2 

DELVC2 

CELVC2 

END; 
CLDN    =    NEW 
C£t_L    SUB     ( 
C*LL    SU3    ( 
ENC; 


>  NEWM  THEN 


(C),  DELVC3  (0)  =  OOOH; 
(1),  DELVC3  (1)  =  OOOH; 
(2),  DELVC3  (2)  =  040H ; 

IM; 

.CELVC2,  .SIGVC2,  .DELVC2); 
.CELVC3,  .SIGVC3,  .DELVC3); 


SET  SIGMA  VC2  AND  SIGMA  VC 3  TO  ZERC 

SIGVC2  (3)  ,  :> 
SIGVC2  (1),  S 
SIGVC2  (2)  ,  S 


IGVC3  (C)  =  OOOH; 
IGVC3  ( 1)  =  OOOH; 
IGVC3  (2)  =  040H; 


CALL  ACD  (  .A3 
CALL  ACD  (.B3 
RETURN; 
ENC  VELPPCC; 


,  .DELVC2,  .VC2); 
,  .DELVC3,  .VC3); 


NAVFPGC:  PROCEDURE; 
/  "** 

NAVIGATION  PROCESSING  FOR  POSITICN  COMPUTATIONS 
*/ 

DECLARE  (R11SCR,  R21SQR,  R31SQR,  R2131)  (3)  BYTE, 
(CIFF1,  DIFF2,  W,  X,  Y,  Z)  (3)  BYTE, 
(TEMPI,  TEMP2,  TEMP3)  (3)  BYTE; 

DECL/RE  ZERO  (3)  BYTE  INITIAL  (OOOH,  OCCH,  040H), 
CNE   (3)  eYTE  INITIAL  (080H,  OOOH,  041H); 

/* 

R11SCR  =  Rll  *  Rll 

*/ 

C*LL  NLLT  (.Rll,  .Rll,  .R11SQR); 


R21SCR    =    R21    *    R21 

*/ 

CALL    VULT     (.R21,     .R21, 


.R21SQR  ); 


RilSQR 

CALL    MULT     (.R31,     .R31,     .R31SQR); 


=    R31    *    R31 
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/* 

R213 

*/ 

CALL 

/* 

ACCI 

THE 

*/ 

R31S 
R21S 
R213 

/* 

CIFF 

*/ 

CALL 

/* 

DIFF 

*/ 

CALL 

/* 

TEMP 

TEMP 

TEMP 

*/ 

CALL 

CALL 

CALL 

/* 

U  = 
X  = 

*/ 

CALL 
CALL 

/* 

TEMP 

TEMP 

Y 

2 

*/ 

CALL 

CALL 

CALL 

CALL 


1  =  R21  *  R31 
MULT  (.R21,  .R31,  .R2131); 


NG  CNE  TO  THE  EXPONENT  VALUE  WILL  CAUSE 
NANTISSA  TC  APPEAR  TO  BE  MULTIPLIED  BY  2 

CR(2)  =  R31SQR  (2)  +  OOIH; 
CR(2)  =  R21SQR  (2)  +  301H; 
1  (2)  =  R2131  (2)  +  OOIH; 


1=2*  (R31  *  R31)  -  Rll  *  Rll 

SUB  (.R31SQR,  .R11SGR,  .DIFF1); 

2=2*  (R21  *  R21)  -  RLL  *  Rll 

SUB  (.R21SQR,  .R11SOR,  .OIFF2); 


1  =  DIFF1  *  EEC 

2  =  DIFF2  *  EEC 

3  =  R2131  *  EEC 


MULT  (.DIFF1,  .EEC, 
NULT  (.DIFF2,  .EEC, 
VULT  (.R2131,  .EEC, 


.TEMPI) ; 
.TEMP2)  ; 
.TEMP3) ; 


1  +  EEC*(2*R31*R3l  -  R11*R11) 
1  +  EEC*(2*R21*R21  -  R11*R11) 

ADD  (.TEMPI,  .ONE,  .W); 
ACC  (.TEMP2,  .ONE,  .X); 


1  =  DVC3  *  ( 1+EEC*(2*R31*R31 

2  =  CVC2  *  (1+EEC*(2*R21*R21 
=  0VC3  *  (EEC*(2*R21*R31)) 
=  CVC2  *  (EEC*(2*R21*R31 )) 

NULT  (.Mi  .DVC3,  .TEMPI); 

^LT  (.X,  .DVC2,  .TEMP2); 

NLLT  (.TEMP3,  .CVC3,  .Y); 

NULT  (.TEMP3,  .DVC2,  .Z); 


R11*R11) ) 
R11*R11  )  ) 


/* 

CHAN 

TEMP 

*/ 

TEfPl  (2)  =  TEMPI  (2)  XOR  080H; 


GE  THE  SIGN  OF  TEMPI 

1  =  -CVC3*(1+EEC*(2*P31*R31  -  R11*R11)) 


/* 
CELT 

*/ 
CALL 

/* 

CELT 

*/ 

CALL 

RETU 
END  NAV 


2  =  -CVC3*(1+EEC*(2*R31*R31-R11*R11) ) 
-  DVC2*(EEC*(2*R21*R31)) 

SUB  (.TEMPI,  .Z,  .CELT2); 


CVC2*(1+EEC*(2*R21*R21-R11*R11) )  + 
CVC3*(EEC*(2*R21*R31) ) 

ADD  (.TEMF2,  .Y,  .DELT3 ) ; 
PN; 
PPCC; 
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CMEGA:  FRCCEDURE; 
DECLARE  (I,J,K)  BYTE, 

(TMFCNE,  TMPTWO)  (3)  BYTE, 
„.„  a  (SUM0ELT2,  SUMDELT3)  (3)  EYTE; 

DECLARE  FI  (3)  BYTE  INITIAL  (0C9H,  OOFH,  042H ) ; 

CALL  INITIALIZE$R; 
CC  K  =  1  TC  6J; 
CC  J  =  1  TO  4; 

SUMCELT2(0),  SUM0ELT3(0)  =  OCCH; 
SUMDELT2(1),  SU^DELT3(1)  =  OOOh; 
SUMDELT2(2),  SUMDELT3<2)  =  040H; 
CO  I  =  1  TO  15; 
CALL  VELPROC; 

/* 

CVC3  =    (VC3    *    DTNAV)/EMER 

CVC2  =    (VC2    *    DTNAV)/EM=R 

*/ 

CALL  MULT    C.VC3,     .DTNAV,     .TNPONE); 

CALL  CIV    (.TMPONE,     .EMER,     .CVC3); 

CALL  VULT    (.VC2,     .CTNAV,     .TMPTWO); 

CALL  DIV    (.TMPTWO,    .EMER,     .CVC2); 

CALL  NAVPROC; 

CALL  ADD  (.SUMDELT2,  .DELT2,  .SUMDELT2); 

CALL  ADD  (.SUMDELT3,  .DELT3,  .SUMDELT2); 

END; 

DELT2(0)  =  SUMDELT210) ; 

DELT2(1)  =  SUMCELT2(1) ; 

DELT2(2)  =  SUMCELT2(2); 

CELT3(0)  =  SUMDELT3(0) ; 

CELT3C1)  =  SUMDELT3(1) ; 

DELT2(2)  =  SUM0ELT3C2) ; 

CALL  NEWFOS; 

CALL    PRINT     (.'  OMEGA    LONG  ITUDE-RAC I ANS $ • ) ; 

CALL    REAL    (.OLCNAC,     0) ; 

CALL  DIV  (.DLONAC,  .RADTOCEG,  .RESULT); 

CALL    PRINT     (.'  OMEGA    LONGITUDE-DEGREES*' ) ; 

CALL  REAL  (.RESULT,  0); 

END; 

ENC; 

RETUFN; 

ENC  CMEGA; 

/*  INITIAL  CCNDITIONS  -  NO  WIND  SOLUTION  FLYING  CUE  EAST 
AT  2C0  KNCTS  FROM  MONTEREY,  CALIF.  AIRPORT  */ 

OLDM  =  C; 
NEW«  =  2; 
NAVVCCE  =  2; 

/*  WINC  CIRECTION  000  DEG  =  O.OOOOOORAD  */ 
WD(3)  =  OCOH; 
WC(  1  )  =  OCOH; 
WC(2)  =  COOH; 

/*  AIRCRAFT  HEADING  090  DEG  =  1.570788  RAD  */ 
ACHCG(C)  =  0C9H; 
ACHCGt 1 )  =  OOFH; 
ACHCGC21  =  0A1H; 

/*  SYSTEM  HEADING  ANGLE  000  DEG  =  O.COOOOO  RAD  */ 
SHDGMO )    =  COCH; 
SHDGA( 1 )  =  OOCH; 
ShCGA(2  )  =  OOOH ; 

VAN(C),  VAE(O),  VDN(O),  VDE(O),  VIN(O),  VIE(O)  =  COCH; 
VAN(l),  VAE(l),  VCN(l),  VDE(l),  VIN(l),  VIE(l)  =  COCH; 
VAN(2),  VAE(2),  VCM2),  VDE(2),  VIN(2),  VIE<2)  =  CCCH; 
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VC3CC)  , 
VC3Q), 
VC3  (2)  , 


VCA(C  ), 
VCA(1  ), 
VCM2  ) 


VCC(O)  , 

VDC(l), 

VDC(2) 


VW(O)  =  oooh; 
vw(i)  =  oooh; 
VW(2)  =  030H; 


/* 

TRIE  MR  SPEED  =  300  KNCTS 
300  KNCTS  =  506.3429575  FT/SEC 
*/ 

VTAS(C)  =  OFDh; 

VTAS(l)  =  02BF; 

VTAS(2)  =  049F; 

/* 

SET  CCRRECTEC  VELOCITY  =  300  KNOTS 
300  KNCTS  =  506.3429575  FT/SEC 
*/ 

VC2(C)  =  ofdh; 

VC2(1)  =  02BH; 

VC2(2)  =  049H; 

/*  NMN  PROGRAM  */ 
CALL  CVEGA; 
HALT; 

ECF 
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